There's an error in the transformation_matrix of Quadrotor
KimKreiss opened this issue · 3 comments
KimKreiss commented
In the code /AerialNavigation/drone_3d_trajectory_following/Quadrotor.py
The rotation part of the transformation matrix has an error
The original term
cos(pitch) * cos(yaw) should be cos(pitch) * cos(roll)
This can be verified by calculating the np.dot(T[:,:3], T[:,:3].T), which should equal an identity matrix.
UjjwalPardeshi commented
can you assign me this please .
AtsushiSakai commented
Can someone paste a link or image for the reference of the quadrotor transformation matrix mathematics here?
KimKreiss commented
Can someone paste a link or image for the reference of the quadrotor transformation matrix mathematics here?
here's a slide https://msl.cs.uiuc.edu/planning/node102.html