![移动机器人原理与设计(原书第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=1739309565-xc1YCcEFfJ9L1wjy0L7pPQElIHyRkqbn-0-71963314f2b87007ef28d4b583aaa25a)
其合并形式为:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/8t4.jpg?sign=1739309565-Oom0LembufSs3qHk95rPnMKQ3INrq19b-0-09d2f6ac94cd66064b57280a310249b0)
角度φ,θ,ψ就是欧拉角,并将其分别称为自转角、章动角和进动角。而橫滚角、俯仰角和偏航角则是一组常用术语,并分别对应于自转角、章动角和进动角。
万向节死锁。当(即cosθ=0),可得:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/8t6.jpg?sign=1739309565-9aSnPvHk0ZNrD55Uf8EycuBrmBPkR2oK-0-45c6874e479c324e6e566955396bf176)
因此:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/8t7.jpg?sign=1739309565-zjTC1FOK7tUraRLKdhfY9xmh6bXq3dVS-0-65f45c2b9f988394414f7814c9f76fee)
这对应于一个奇异点,即当时,便无法用欧拉角在旋转矩阵SO(3)的流形上实现全方位移动。这意味着一些轨迹R(t)便不能跟随欧拉角。
欧拉角的旋转矩阵。给定某一旋转矩阵R,可根据式(1.9)很容易解出这三个欧拉角,其公式如下:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/8t9.jpg?sign=1739309565-24LrxlR1yOlCEOnuaxqBYXDfFXf7pgUk-0-f1d730075a807acfc465f00adfba814a)
通过限定其取值范围,ψ
[-π,π],可得:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/8t11.jpg?sign=1739309565-Afkh0E3ka87oLpbQJx6Pn15JcvDKSTS1-0-9978ba697b5df4455c0fde5d1d359873)
此时,atan2是二变量的反正切函数,可由下式定义:
![](https://epubservercos.yuewen.com/9D1A5D/21647389701428506/epubprivate/OEBPS/Images/8t12.jpg?sign=1739309565-FTaDXv5W45Hz7NKO0Zq1eKS3P8XSDLmh-0-525bfdfc0b5be508a28c4f7bd208bf30)