使用python +/- matplotlib绘制机器人路径和方向

import matplotlib.pyplot as plt

fig, ax = plt.subplots()

start_x = 0
start_y = 0
start_direction = 0  # 以角度表示，0度为正右方，逆时针增加

path = [(0, 0), (1, 1), (2, 1), (3, 2)]  # 机器人的路径坐标点
directions = [0, 45, 90, 135]  # 机器人的方向角度

# 绘制机器人的路径
x_values = [point[0] for point in path]
y_values = [point[1] for point in path]
ax.plot(x_values, y_values, '-o', label='Path')

# 绘制机器人的方向
for i in range(len(path)):
    x = path[i][0]
    y = path[i][1]
    direction = directions[i]
    dx = 0.2 * cos(radians(direction))  # 方向箭头的长度
    dy = 0.2 * sin(radians(direction))  # 方向箭头的宽度
    ax.arrow(x, y, dx, dy, head_width=0.1, head_length=0.1, fc='r', ec='r')

# 设置图形的标题和坐标轴标签
ax.set_title('Robot Path and Direction')
ax.set_xlabel('X')
ax.set_ylabel('Y')

# 显示图例
ax.legend()

# 显示图形
plt.show()