![移动机器人原理与设计(原书第2版)](https://wfqqreader-1252317822.image.myqcloud.com/cover/158/41517158/b_41517158.jpg)
上QQ阅读APP看书,第一时间看更新
1.2 欧拉角
1.2.1 定义
在相关文献中,1770年欧拉为了表示空间内刚体的方向,提出了一些没有明确定义的角度。在此主要区别橫滚—偏航—橫滚、橫滚—俯仰—橫滚以及橫滚—俯仰—偏航三种表达。因为要将其施加于移动机器人语言中,所以后文将对其进行选择。在橫滚—俯仰—偏航规划中,欧拉角有时被称为卡尔丹角。R3内的任意旋转矩阵可以用以下三个矩阵内积的形式来表示:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/8t3.jpg?sign=1739112584-ZHBCAJ8LIvrqRfSnjtW9oGnr8HM1wtlg-0-e77b6950d1cdb24820f6b7d68c8552bd)
其合并形式为:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/8t4.jpg?sign=1739112584-EVC5uHoQ9eVi2ph49RjLhgIS3zuyPUvA-0-1015daca86ca472684a39de8119bf533)
角度φ,θ,ψ就是欧拉角,并将其分别称为自转角、章动角和进动角。而橫滚角、俯仰角和偏航角则是一组常用术语,并分别对应于自转角、章动角和进动角。
万向节死锁。当(即cosθ=0),可得:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/8t6.jpg?sign=1739112584-bhpK09k8x3FI5I2QaVuSdVR0tJKHOrcA-0-0c69633ac09f38692b5cc8d2f968e6dc)
因此:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/8t7.jpg?sign=1739112584-iUPHWV5j8QKRfDa67TQrubwFITvCwhEi-0-dc10f09aeea73a44f382024cade72f24)
这对应于一个奇异点,即当时,便无法用欧拉角在旋转矩阵SO(3)的流形上实现全方位移动。这意味着一些轨迹R(t)便不能跟随欧拉角。
欧拉角的旋转矩阵。给定某一旋转矩阵R,可根据式(1.9)很容易解出这三个欧拉角,其公式如下:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/8t9.jpg?sign=1739112584-RZ9c32cjC663Fm7U8IGzotHA9ezxYqeW-0-4d3e76f8b6c2fd258b4b9c97c921e159)
通过限定其取值范围,ψ
[-π,π],可得:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/8t11.jpg?sign=1739112584-22eTVbqGSu4GTXMc6e8hilaZjODzZP6x-0-0864409bd35188b12cf076c33be9d4bd)
此时,atan2是二变量的反正切函数,可由下式定义:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/8t12.jpg?sign=1739112584-0ODA7k65QkKPh4u0nscsJEEuMM8xcekc-0-787b1346c8ef9e006d9509db8226e7c7)