理论教育 基于姿态矩阵导数的刚体转动角速度确定方法

基于姿态矩阵导数的刚体转动角速度确定方法

时间:2023-06-16 理论教育 版权反馈
【摘要】:按照矩阵求导定义,每个元素都对时间t求导,则依据式可得将式代入式可得式也可以参照上述求“向量”导数的方法,利用R对时间求导的定义=求得。式或式提供了一种求机器人任意连杆i瞬时转动角速度向量的有效方法。

基于姿态矩阵导数的刚体转动角速度确定方法

按照矩阵求导定义,每个元素都对时间t求导,则

依据式(5-12)可得

将式(5-16)代入式(5-15)可得

式(5-17)也可以参照上述求“向量”导数的方法,利用R对时间求导的定义求得。

因为矩阵R是正交矩阵,其逆矩阵等于其转置矩阵,即R-1R T,式(5-17)两边同时右乘R T可得

由上式可以求出角速度Aω=[AωxAωyAωzT的具体表达式。因为

由上式可得(www.daowen.com)

因为k=[kxkykzT是单位向量,即‖k‖==1,式(5-19)中的三个等式两边分别平方,再相加可得

故旋转角速度

将式(5-20)代入式(5-19)得刚体瞬时转动轴k=[kxkykzT,其中

由式(5-21)仅能确定刚体瞬时转动轴线l的方向,而旋转轴线的具体位置则可以利用式(2-47)确定。

式(5-18)或式(5-19)提供了一种求机器人任意连杆i瞬时转动角速度向量的有效方法。这是因为对于一个n自由度机器人,由式(3-4)可确定其任意连杆i在t时刻相对于机器人基坐标系{0}的位姿矩阵为;将中的Ri及其导数代入式(5-18),可求得连杆i相对于机器人基坐标系{0}转动的角速度向量Aωi0ωi

免责声明:以上内容源自网络,版权归原作者所有,如有侵犯您的原创版权请告知,我们将尽快删除相关内容。

我要反馈