123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290 |
- import math
- import sys
- # 巷道间距
- # 计算旋转角度
- def calculate_route(point_1, point_2):
- a, b = point_1
- c, d = point_2
- if a == c:
- return 1
- else:
- return math.atan((d - b) / (c - a))
- # 计算旋转坐标
- def calculate_route_coordinate(point, route):
- x = point[0]
- y = point[1]
- x1 = x * math.cos(route) + y * math.sin(route)
- y1 = -x * math.sin(route) + y * math.cos(route)
- return (x1, y1)
- def find_point_on_line(A, B, fraction):
- """
- 计算线段AB上距离A点fraction长度处的点C的坐标。
- 参数:
- A -- 点A的坐标,形式为(x1, y1)
- B -- 点B的坐标,形式为(x2, y2)
- fraction -- 线段AB上距离A点的比例(0到1之间)
- 返回:
- 点C的坐标,形式为(x, y)
- """
- x1, y1 = A
- x2, y2 = B
- # 使用线性插值计算C点的坐标
- x = x1 + (x2 - x1) * fraction
- y = y1 + (y2 - y1) * fraction
- return (x, y)
- def scale_point(x, y, k):
- """
- 缩放二维点坐标。
- 参数:
- x, y: 原点的x和y坐标。
- k: 缩放因子。
- 返回:
- 新的x'和y'坐标。
- """
- x_prime = k * x
- y_prime = k * y
- return x_prime, y_prime
- # 计算 a点到b点之间1/x处(距离a点)的c点坐标
- def calculate_point_c(point_a, point_b, x):
- x_a, y_a = point_a
- x_b, y_b = point_b
- # 计算方向向量
- dx = x_b - x_a
- dy = y_b - y_a
- # 计算方向向量的模长
- distance_ab = math.sqrt(dx ** 2 + dy ** 2)
- # 计算单位方向向量
- unit_vector_x = dx / distance_ab
- unit_vector_y = dy / distance_ab
- # 计算点C的坐标
- x_c = x_a + (1 / x) * unit_vector_x
- y_c = y_a + (1 / x) * unit_vector_y
- return x_c, y_c
- # 找线段之间某点的坐标
- def rotate_point_around_another(point_a, point_b, a):
- x_a, y_a = point_a
- x_b, y_b = point_b
- """
- 旋转点A(x_a, y_a)围绕点B(x_b, y_b) a 弧度后的新坐标。
- """
- # 将A点的坐标转换到以B点为原点的坐标系中
- dx = x_a - x_b
- dy = y_a - y_b
- # 旋转坐标
- x_prime = dx * math.cos(a) - dy * math.sin(a)
- y_prime = dx * math.sin(a) + dy * math.cos(a)
- # 将旋转后的坐标转换回原来的坐标系
- x_rotated = x_prime + x_b
- y_rotated = y_prime + y_b
- return x_rotated, y_rotated
- def calculate_angle_with_x_axis(point1, point2):
- x1, y1 = point1
- x2, y2 = point2
- """
- 计算线段(x1, y1)到(x2, y2)与x轴的夹角(以弧度为单位)。
- 结果角度是从x轴正方向逆时针旋转到线段方向所经过的角度。
- """
- # 首先计算线段的斜率
- if x1 == x2: # 避免除以零
- if y2 > y1:
- return math.pi / 2 # 垂直于x轴且向上
- elif y2 < y1:
- return -math.pi / 2 # 垂直于x轴且向下
- else:
- return 0 # 与x轴重合
- else:
- slope = (y2 - y1) / (x2 - x1)
- # 使用atan2计算角度,它返回从x轴正方向到点(y, x)的向量与x轴之间的夹角
- # 注意:atan2的参数顺序是(y的差, x的差),即(y2-y1, x2-x1)
- angle_radians = math.atan2(y2 - y1, x2 - x1)
- return angle_radians
- def get_color_by_layer(layer_id):
- return {
- '1': 53,
- '2': 83,
- '3': 133,
- '4': 173,
- '5': 162,
- '6': 77
- }.get(layer_id)
- def min_distance_between_segments(seg1, seg2):
- """
- 计算两条线段之间的最小距离(基于端点之间的最小距离)
- seg1, seg2: 线段的端点坐标,例如 [(x1, y1), (x2, y2)]
- """
- # 提取端点
- p1, p2 = seg1
- p3, p4 = seg2
- # 计算所有端点之间的距离
- dist1 = distance(p1, p3)
- dist2 = distance(p1, p4)
- dist3 = distance(p2, p3)
- dist4 = distance(p2, p4)
- # 返回最小距离
- return min(dist1, dist2, dist3, dist4)
- def distance(p1, p2):
- """计算两点之间的距离"""
- return math.sqrt((p2[0] - p1[0]) ** 2 + (p2[1] - p1[1]) ** 2)
- def symmetric_point(A, B):
- """
- 计算点A相对于点B的对称点C的坐标
- 参数:
- A -- 点A的坐标,形式为(x_a, y_a)
- B -- 点B的坐标,形式为(x_b, y_b)
- 返回:
- 点C的坐标,形式为(x_c, y_c)
- """
- x_a, y_a = A
- x_b, y_b = B
- x_c = 2 * x_b - x_a
- y_c = 2 * y_b - y_a
- return x_c, y_c
- def divide_segment(A, B, x):
- # A 和 B 是元组,表示线段的两个端点 (x, y)
- # x 是分割段数
- # 计算线段 AB 的长度
- length_AB = ((B[0] - A[0]) ** 2 + (B[1] - A[1]) ** 2) ** 0.5
- # 计算每段的长度
- segment_length = length_AB / (x + 1) # 加1是因为包括端点在内有x+1个点
- # 初始化点的列表,包括起点 A
- points = [A]
- # 使用线性插值法计算每个分割点的坐标
- for i in range(1, x + 1):
- t = i / (x + 1) # 插值参数,从0到1
- Cx = A[0] + t * (B[0] - A[0])
- Cy = A[1] + t * (B[1] - A[1])
- points.append((Cx, Cy))
- # 包括终点 B
- points.append(B)
- return points
- def parallel_line(start, end, distance):
- """
- 计算与给定线段平行且距离为distance的线段(只返回上方的一条)。
- 参数:
- start -- 原始线段的起点坐标,形式为(x, y)
- end -- 原始线段的终点坐标,形式为(x, y)
- distance -- 平行线段与原始线段的距离
- 返回:
- tuple -- 平行线段的起点和终点坐标,形式为((new_start_x, new_start_y), (new_end_x, new_end_y))
- """
- # 计算原始线段的斜率
- if start[0] == end[0]: # 斜率不存在(垂直线)
- # 对于垂直线,我们只需在x坐标上保持不变,y坐标增减distance
- new_start = (start[0], start[1] + distance)
- new_end = (end[0], end[1] + distance)
- else:
- # 计算斜率
- slope = (end[1] - start[1]) / (end[0] - start[0])
- # 计算法线的斜率(负倒数)
- if slope == 0:
- slope = 1
- normal_slope = -1 / slope
- # 计算法线方向上从起点到距离distance的点的偏移量
- # 注意:这里我们使用勾股定理的简化形式,因为距离是垂直于线段的
- # 实际上,我们只需要y方向的偏移量,因为x方向的偏移量由斜率决定
- dx = distance / math.sqrt(1 + slope ** 2)
- dy = slope * dx
- # 计算新线段的起点和终点
- # 注意:这里我们假设距离是正值,只计算上方的平行线
- # 如果需要下方的平行线,可以将dy的符号取反
- new_start = (start[0] - dy / slope, start[1] + dx)
- new_end = (end[0] - dy / slope, end[1] + dx)
- # 注意:上面的计算方式在斜率为负时可能不正确,因为它没有考虑线段的方向
- # 一种更健壮的方法是分别计算与start和end距离为distance的点,然后取这两个点作为新线段的端点
- # 但为了简单起见,这里我们假设斜率不是负数或垂直线的情况已经处理
- # 注意:上面的计算方式在斜率为负或接近0时可能不准确,下面是一个更准确的版本
- # 它直接计算与start和end等距的点
- # 考虑到斜率可能接近无穷(即几乎垂直),我们使用向量叉积的概念来避免除以0
- vector = (end[0] - start[0], end[1] - start[1])
- norm = (-vector[1], vector[0]) # 法线向量
- norm_length = math.sqrt(norm[0] ** 2 + norm[1] ** 2)
- unit_norm = (norm[0] / norm_length, norm[1] / norm_length) # 单位法线向量
- offset_point_start = (start[0] + unit_norm[0] * distance, start[1] + unit_norm[1] * distance)
- offset_point_end = (end[0] + unit_norm[0] * distance, end[1] + unit_norm[1] * distance)
- return (offset_point_start, offset_point_end)
- def shrink_line(start, end, scale_factor):
- """
- 将线段缩小指定的倍数。
- 参数:
- start -- 原始线段的起点坐标,形式为(x, y)
- end -- 原始线段的终点坐标,形式为(x, y)
- scale_factor -- 缩小倍数,例如0.5表示缩小到原来的一半
- 返回:
- tuple -- 缩小后的线段的起点和终点坐标,形式为((new_start_x, new_start_y), (new_end_x, new_end_y))
- """
- # 计算原始线段的长度和方向向量
- length = ((end[0] - start[0]) ** 2 + (end[1] - start[1]) ** 2) ** 0.5
- direction = ((end[0] - start[0]) / length, (end[1] - start[1]) / length)
- # 计算缩小后的线段的长度
- new_length = length * scale_factor
- # 计算缩小后的线段的起点和终点
- new_start = start
- new_end = (start[0] + direction[0] * new_length, start[1] + direction[1] * new_length)
- return (new_start, new_end)
|