引言
在推导动力学过程中发现了自己对于相关知识还有好多漏洞,尤其是旋转坐标系下的角速度变化率和世界坐标系下的角速度的关系难以理解,于是写下自己学习过程中的心得。
我们常用的都是通过RPY的旋转变换来达到旋转坐标系,绕轴的转动顺序则是X-Y-Z。
RPY角 :指绕世界坐标系旋转(即绕的轴在整个旋转中是固定不变的),依次绕X轴(roll角),Y轴(pitch角),Z轴(yaw角)进行旋转。
旋转坐标系下的转动的角度为,则在旋转坐标系下转动角度变化率为
而我们需要的是旋转坐标系中物体在世界坐标系下的角速度,这就需要通过相关的旋转矩阵来进行组合转换。
相关公式
其中,对于每个转动轴的旋转矩阵为:
总旋转矩阵为:
公式推导
角速度在世界坐标系下可以表示为
1.首先,绕着世界坐标系下的Z轴进行第一次旋转。
2.其次,绕世界坐标系下的Z轴进行旋转后,在绕y轴进行旋转,为右乘法。(从旋转坐标系来看,则是在旋转角度变化率的基础上先进行y 轴的旋转,然后在进行Z轴的旋转,为左乘法)。
3.最后,则是在前两次旋转的基础上在进行X轴的旋转。(在旋转坐标系下同理)
然后将三者进行相加,就可以得到角速度与角度变化率的关系: