我正在从文本文件加载 x,y 坐标和偏航角。这些坐标是正方形中间的坐标,yaw 是正方形与 x 轴的角度。在我的文本文件中,坐标正在变化。我想制作一个动画,其中方块将移动(遵循文件中的坐标)并具有精确的偏航角。一个动画刻度应该代表一个方块移动。我尝试了这段代码,它非常糟糕并且无法工作。有任何想法吗?谢谢。现在,我使用左下角而不是正方形的中间。
import numpy as np
import matplotlib.pyplot as plt
import matplotlib.patches as patches
import matplotlib as mpl
from matplotlib import animation
file_name = "Crobot_test_log.txt"
x = np.loadtxt(file_name, usecols=(0,))
y = np.loadtxt(file_name, usecols=(1,))
yaw = np.loadtxt(file_name, usecols=(2,))
#x = [0,1,2]
#y = [0,1,2]
#yaw = [0.0,0.5,1.3]
fig = plt.figure()
plt.axis('equal')
plt.grid()
ax = fig.add_subplot(111)
ax.set_xlim(-10, 10)
ax.set_ylim(-10, 10)
patch = patches.Rectangle((x[0],y[0]),1.2,1.0,fc ='y',angle = -np.rad2deg(yaw[0]))
def init():
ax.add_patch(patch)
return patch,
def animate(i):
patch = patches.Rectangle((x[i],y[i]),1.2,1.0,fc ='y',angle = -np.rad2deg(yaw[i]))
return patch,
anim = animation.FuncAnimation(fig, animate,
init_func=init,
frames=360,
interval=1,
blit=True)
plt.show()