core.py 8.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290
  1. import math
  2. import sys
  3. # 巷道间距
  4. # 计算旋转角度
  5. def calculate_route(point_1, point_2):
  6. a, b = point_1
  7. c, d = point_2
  8. if a == c:
  9. return 1
  10. else:
  11. return math.atan((d - b) / (c - a))
  12. # 计算旋转坐标
  13. def calculate_route_coordinate(point, route):
  14. x = point[0]
  15. y = point[1]
  16. x1 = x * math.cos(route) + y * math.sin(route)
  17. y1 = -x * math.sin(route) + y * math.cos(route)
  18. return (x1, y1)
  19. def find_point_on_line(A, B, fraction):
  20. """
  21. 计算线段AB上距离A点fraction长度处的点C的坐标。
  22. 参数:
  23. A -- 点A的坐标,形式为(x1, y1)
  24. B -- 点B的坐标,形式为(x2, y2)
  25. fraction -- 线段AB上距离A点的比例(0到1之间)
  26. 返回:
  27. 点C的坐标,形式为(x, y)
  28. """
  29. x1, y1 = A
  30. x2, y2 = B
  31. # 使用线性插值计算C点的坐标
  32. x = x1 + (x2 - x1) * fraction
  33. y = y1 + (y2 - y1) * fraction
  34. return (x, y)
  35. def scale_point(x, y, k):
  36. """
  37. 缩放二维点坐标。
  38. 参数:
  39. x, y: 原点的x和y坐标。
  40. k: 缩放因子。
  41. 返回:
  42. 新的x'和y'坐标。
  43. """
  44. x_prime = k * x
  45. y_prime = k * y
  46. return x_prime, y_prime
  47. # 计算 a点到b点之间1/x处(距离a点)的c点坐标
  48. def calculate_point_c(point_a, point_b, x):
  49. x_a, y_a = point_a
  50. x_b, y_b = point_b
  51. # 计算方向向量
  52. dx = x_b - x_a
  53. dy = y_b - y_a
  54. # 计算方向向量的模长
  55. distance_ab = math.sqrt(dx ** 2 + dy ** 2)
  56. # 计算单位方向向量
  57. unit_vector_x = dx / distance_ab
  58. unit_vector_y = dy / distance_ab
  59. # 计算点C的坐标
  60. x_c = x_a + (1 / x) * unit_vector_x
  61. y_c = y_a + (1 / x) * unit_vector_y
  62. return x_c, y_c
  63. # 找线段之间某点的坐标
  64. def rotate_point_around_another(point_a, point_b, a):
  65. x_a, y_a = point_a
  66. x_b, y_b = point_b
  67. """
  68. 旋转点A(x_a, y_a)围绕点B(x_b, y_b) a 弧度后的新坐标。
  69. """
  70. # 将A点的坐标转换到以B点为原点的坐标系中
  71. dx = x_a - x_b
  72. dy = y_a - y_b
  73. # 旋转坐标
  74. x_prime = dx * math.cos(a) - dy * math.sin(a)
  75. y_prime = dx * math.sin(a) + dy * math.cos(a)
  76. # 将旋转后的坐标转换回原来的坐标系
  77. x_rotated = x_prime + x_b
  78. y_rotated = y_prime + y_b
  79. return x_rotated, y_rotated
  80. def calculate_angle_with_x_axis(point1, point2):
  81. x1, y1 = point1
  82. x2, y2 = point2
  83. """
  84. 计算线段(x1, y1)到(x2, y2)与x轴的夹角(以弧度为单位)。
  85. 结果角度是从x轴正方向逆时针旋转到线段方向所经过的角度。
  86. """
  87. # 首先计算线段的斜率
  88. if x1 == x2: # 避免除以零
  89. if y2 > y1:
  90. return math.pi / 2 # 垂直于x轴且向上
  91. elif y2 < y1:
  92. return -math.pi / 2 # 垂直于x轴且向下
  93. else:
  94. return 0 # 与x轴重合
  95. else:
  96. slope = (y2 - y1) / (x2 - x1)
  97. # 使用atan2计算角度,它返回从x轴正方向到点(y, x)的向量与x轴之间的夹角
  98. # 注意:atan2的参数顺序是(y的差, x的差),即(y2-y1, x2-x1)
  99. angle_radians = math.atan2(y2 - y1, x2 - x1)
  100. return angle_radians
  101. def get_color_by_layer(layer_id):
  102. return {
  103. '1': 53,
  104. '2': 83,
  105. '3': 133,
  106. '4': 173,
  107. '5': 162,
  108. '6': 77
  109. }.get(layer_id)
  110. def min_distance_between_segments(seg1, seg2):
  111. """
  112. 计算两条线段之间的最小距离(基于端点之间的最小距离)
  113. seg1, seg2: 线段的端点坐标,例如 [(x1, y1), (x2, y2)]
  114. """
  115. # 提取端点
  116. p1, p2 = seg1
  117. p3, p4 = seg2
  118. # 计算所有端点之间的距离
  119. dist1 = distance(p1, p3)
  120. dist2 = distance(p1, p4)
  121. dist3 = distance(p2, p3)
  122. dist4 = distance(p2, p4)
  123. # 返回最小距离
  124. return min(dist1, dist2, dist3, dist4)
  125. def distance(p1, p2):
  126. """计算两点之间的距离"""
  127. return math.sqrt((p2[0] - p1[0]) ** 2 + (p2[1] - p1[1]) ** 2)
  128. def symmetric_point(A, B):
  129. """
  130. 计算点A相对于点B的对称点C的坐标
  131. 参数:
  132. A -- 点A的坐标,形式为(x_a, y_a)
  133. B -- 点B的坐标,形式为(x_b, y_b)
  134. 返回:
  135. 点C的坐标,形式为(x_c, y_c)
  136. """
  137. x_a, y_a = A
  138. x_b, y_b = B
  139. x_c = 2 * x_b - x_a
  140. y_c = 2 * y_b - y_a
  141. return x_c, y_c
  142. def divide_segment(A, B, x):
  143. # A 和 B 是元组,表示线段的两个端点 (x, y)
  144. # x 是分割段数
  145. # 计算线段 AB 的长度
  146. length_AB = ((B[0] - A[0]) ** 2 + (B[1] - A[1]) ** 2) ** 0.5
  147. # 计算每段的长度
  148. segment_length = length_AB / (x + 1) # 加1是因为包括端点在内有x+1个点
  149. # 初始化点的列表,包括起点 A
  150. points = [A]
  151. # 使用线性插值法计算每个分割点的坐标
  152. for i in range(1, x + 1):
  153. t = i / (x + 1) # 插值参数,从0到1
  154. Cx = A[0] + t * (B[0] - A[0])
  155. Cy = A[1] + t * (B[1] - A[1])
  156. points.append((Cx, Cy))
  157. # 包括终点 B
  158. points.append(B)
  159. return points
  160. def parallel_line(start, end, distance):
  161. """
  162. 计算与给定线段平行且距离为distance的线段(只返回上方的一条)。
  163. 参数:
  164. start -- 原始线段的起点坐标,形式为(x, y)
  165. end -- 原始线段的终点坐标,形式为(x, y)
  166. distance -- 平行线段与原始线段的距离
  167. 返回:
  168. tuple -- 平行线段的起点和终点坐标,形式为((new_start_x, new_start_y), (new_end_x, new_end_y))
  169. """
  170. # 计算原始线段的斜率
  171. if start[0] == end[0]: # 斜率不存在(垂直线)
  172. # 对于垂直线,我们只需在x坐标上保持不变,y坐标增减distance
  173. new_start = (start[0], start[1] + distance)
  174. new_end = (end[0], end[1] + distance)
  175. else:
  176. # 计算斜率
  177. slope = (end[1] - start[1]) / (end[0] - start[0])
  178. # 计算法线的斜率(负倒数)
  179. if slope == 0:
  180. slope = 1
  181. normal_slope = -1 / slope
  182. # 计算法线方向上从起点到距离distance的点的偏移量
  183. # 注意:这里我们使用勾股定理的简化形式,因为距离是垂直于线段的
  184. # 实际上,我们只需要y方向的偏移量,因为x方向的偏移量由斜率决定
  185. dx = distance / math.sqrt(1 + slope ** 2)
  186. dy = slope * dx
  187. # 计算新线段的起点和终点
  188. # 注意:这里我们假设距离是正值,只计算上方的平行线
  189. # 如果需要下方的平行线,可以将dy的符号取反
  190. new_start = (start[0] - dy / slope, start[1] + dx)
  191. new_end = (end[0] - dy / slope, end[1] + dx)
  192. # 注意:上面的计算方式在斜率为负时可能不正确,因为它没有考虑线段的方向
  193. # 一种更健壮的方法是分别计算与start和end距离为distance的点,然后取这两个点作为新线段的端点
  194. # 但为了简单起见,这里我们假设斜率不是负数或垂直线的情况已经处理
  195. # 注意:上面的计算方式在斜率为负或接近0时可能不准确,下面是一个更准确的版本
  196. # 它直接计算与start和end等距的点
  197. # 考虑到斜率可能接近无穷(即几乎垂直),我们使用向量叉积的概念来避免除以0
  198. vector = (end[0] - start[0], end[1] - start[1])
  199. norm = (-vector[1], vector[0]) # 法线向量
  200. norm_length = math.sqrt(norm[0] ** 2 + norm[1] ** 2)
  201. unit_norm = (norm[0] / norm_length, norm[1] / norm_length) # 单位法线向量
  202. offset_point_start = (start[0] + unit_norm[0] * distance, start[1] + unit_norm[1] * distance)
  203. offset_point_end = (end[0] + unit_norm[0] * distance, end[1] + unit_norm[1] * distance)
  204. return (offset_point_start, offset_point_end)
  205. def shrink_line(start, end, scale_factor):
  206. """
  207. 将线段缩小指定的倍数。
  208. 参数:
  209. start -- 原始线段的起点坐标,形式为(x, y)
  210. end -- 原始线段的终点坐标,形式为(x, y)
  211. scale_factor -- 缩小倍数,例如0.5表示缩小到原来的一半
  212. 返回:
  213. tuple -- 缩小后的线段的起点和终点坐标,形式为((new_start_x, new_start_y), (new_end_x, new_end_y))
  214. """
  215. # 计算原始线段的长度和方向向量
  216. length = ((end[0] - start[0]) ** 2 + (end[1] - start[1]) ** 2) ** 0.5
  217. direction = ((end[0] - start[0]) / length, (end[1] - start[1]) / length)
  218. # 计算缩小后的线段的长度
  219. new_length = length * scale_factor
  220. # 计算缩小后的线段的起点和终点
  221. new_start = start
  222. new_end = (start[0] + direction[0] * new_length, start[1] + direction[1] * new_length)
  223. return (new_start, new_end)