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