Results 3 comments of Mr_yy

Sorry, I have not understood yet. I know the Z-axis in world frame is alone with the gravity vector([0,0,9.8]^T), but I can't understand how the yaw angle set zero. Can...

@QMonteCarlo Thank you for your reply. Can you explain how the yaw angle set zero according to the code.

@QMonteCarlo Thank you very much for you answer. But I have not understood clearly about the yaw2. The formular in the program should be yaw2 = yaw(Ry(pitch1)*Rx(roll1)*Rz(yaw_Rs)*Ry(pitch_Rs)*Rxz(roll_Rs)), I still doubt...