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