Python 确定2D数组中两点之间的旋转

若要将第三个值添加到包含以90度为增量的旋转的每个元组，可以使用以下Python代码:

import math

def normalize_vector(vector):
    length = math.sqrt(vector[0] ** 2 + vector[1] ** 2)
    if length == 0:
        return [0, 0]
    else:
        return [vector[0] / length, vector[1] / length]

def calculate_angle(vector1, vector2):
    angle_radians = math.atan2(vector2[1], vector2[0]) - math.atan2(vector1[1], vector1[0])
    
    # Convert radians to degrees
    angle_degrees = math.degrees(angle_radians)
    
    # Ensure the angle is in the range of -180 to 180 degrees
    if angle_degrees > 180:
        angle_degrees -= 360
    elif angle_degrees < -180:
        angle_degrees += 360
    
    return angle_degrees

# Example usage:
input_points = [
    [3, 1],
    [3, 0],
    [2, 0],
    [3, 0],
    [3, 1],
    [3, 2],
    [2, 2],
    [2, 3],
    [1, 3],
    [1, 2],
    [0, 2],
    [1, 2],
    [1, 1],
    [1, 0],
    [0, 0],
    [0, 1],
]

current_direction = [-1, 0]

# Store the results in a list
result = []

for i, point in enumerate(input_points[:-1]):
    current_direction = normalize_vector(current_direction)
    next_direction = normalize_vector([input_points[i + 1][0] - point[0], input_points[i + 1][1] - point[1]])
    angle = -calculate_angle(current_direction, next_direction)#negative sign (-) indicating a counter-clockwise turn
    

    # Ensure the angle is in the range of -180 to 180 degrees
    if angle > 180:
        angle -= 360
    elif angle < -180:
        angle += 360

    result.append([point[0], point[1], angle])
    current_direction = next_direction

# Print the results
print(result)

Output of the code:[[3，1，-90.0]，[3，0，90.0]，[2，0，180.0]，[3，0，-90.0]，[3，1，-0.0]，[3，2，-90.0]，[2，2，90.0]，[2，3，-90.0]，[1，3，-90.0]，[1，2，90.0]，[0，2，180.0]，[1，2，90.0]，[1，1，-0.0]，[1，0，90.0]，[0，0，90.0]]

此代码将接受一组点作为输入，其中每个点都表示为[x，y].它计算连续点之间的旋转Angular ，并将该Angular 附加到格式为[X，Y，ROTATION_ANGLE]的每个元组.ROTATION_ANGLE的增量为90度，负号(-)表示逆时针旋转.