• 机器人学——1.5-奇异点及万向节锁


    之前叙述的三旋转角度表示方式中,一个重要的问题是奇异点。当中间的绕旋转轴旋转到另外两个轴平行时,这个情况就会发生。对于万向节锁(因电影《阿波罗13号》而出名的术语),也存在同样的问题。

    用于导航的机械陀螺仪如图所示。在其最核心的装配结构中有 33 个相互正交的框架,它们能使安装于其中的稳定体相对于宇宙静止。陀螺仪通过这个万向节机构连接到飞船机体上,这样无论飞船做任何机动飞行,都不会给陀螺仪内部的稳定平台施加外力矩。通过测量这些万向框架的轴相对于稳定平台的转动角度,就可以确定飞船的航行姿态——直接显示出飞船的横滚-俯仰-偏航角,图示设计中是卡尔丹角的 YZXYZX 序列。(“登月舱坐标系是右手坐标系,+X+X 轴朝上,+Z+Z 轴朝前,+Y+Y 轴指向右边。旋转变换矩阵由一个基于 2312-3-1 顺序的欧拉角构成,即:首先关于 YY 轴倾斜,然后绕 ZZ 轴滚动,最后关于 XX 轴俯仰。正旋转分别是上倾,右滚,左偏)

    现在考虑陀螺仪中间万向架旋转角(相对于飞船的z轴旋转)为 90°90° 时的情况。这时陀螺仪的内万向架与外万向架的轴对齐,它们的旋转轴线重合。因为这两个旋转轴平行,这时陀螺仪只有两个有效的旋转轴,而不是原来的三个——我们称之为丢失了一个自由度。
    在这里插入图片描述
    从数学(而非机械)上看,这个问题可以通过建立一种登月舱坐标系来解释,其中固联在飞船机体上的坐标系 {B}{B} 相对于固联在稳定平台上的坐标系 {S}{S} 做旋转,并且可以表示为
    SRB=Ry(θp)Rz(θr)Rx(θy) ^SR_B=R_y( heta_p)R_z( heta_r)R_x( heta_y)

    旋转须服从循环旋转规则:
    RX(π/2)RY(θ)RX(π/2)TRZ(θ) R_X(pi/2)R_Y( heta)R_X(pi/2)^T equiv R_Z( heta) RY(π/2)RZ(θ)RY(π/2)TRX(θ) R_Y(pi/2)R_Z( heta)R_Y(pi/2)^T equiv R_X( heta) RZ(π/2)RX(θ)RZ(π/2)TRY(θ) R_Z(pi/2)R_X( heta)R_Z(pi/2)^T equiv R_Y( heta) 以及反循环旋转规则:
    RY(π/2)TRX(θ)RY(π/2)RZ(θ) R_Y(pi/2)^TR_X( heta)R_Y(pi/2) equiv R_Z( heta) RZ(π/2)TRY(θ)RZ(π/2)RX(θ) R_Z(pi/2)^TR_Y( heta)R_Z(pi/2) equiv R_X( heta)

    θr=π/2 heta_r=pi/2 时,可以应用循环旋转规则得到下面的恒等式:
    Ry(θ)Rz(π2)=Rz(π2)Rx(θ) R_y( heta)R_z(frac{pi}{2}) = R_z(frac{pi}{2})R_x( heta) 进而得到
    SRB=Rz(π2)Rx(θp)Rx(θy)=Rz(π2)Rx(θp+θy) ^SR_B= R_z(frac{pi}{2})R_x( heta_p)R_x( heta_y)=R_z(frac{pi}{2})R_x( heta_p+ heta_y) 上式中没有表示出飞船绕 yy 轴的旋转。这就带来了问题,因为航天器绕 yy 轴的旋转将使稳定平台也旋转,从而破坏其相对于恒星的精确对准。

    一个自由度的缺失意味着在数学上我们不能反变换(相当于被降维打击了),我们只能建立两个角度之间的线性关系。在这种情况下,我们最多也只能确定俯仰角和偏航角的总和。前面我们用欧拉角的奇异点也看到了类似的现象。

    所有三角度形式的姿态表示,无论欧拉式或卡尔丹式,当两连续轴共线时都会遇到万向节锁同样的问题。对于 ZYZZYZ 形式的欧拉角,它发生在 θ=kπ,kZ heta=kpi, kinmathbb{Z} 时,对于用横滚-俯仰-偏航角的情况,会发生在θ=±(2k+1)π/2 heta= pm(2k+1)pi/2时。虽然都存在奇异点,但我们可以想办法让奇异点不在航行体正常运行时出现,这需要明智地选择角度序列和坐标系。

    奇异点是采用最简化方法带来的一个不幸后果。为了消除这个问题,我们必须采取其他的姿态描述方法。其中,阿波罗登月舱团队的人提出一种用四个万向支架的系统,其成功的关键是引进了第四个参数,我们之后会讨论相关的四元数的内容。

  • 相关阅读:
    矩阵构造方法(转载)
    欧拉函数
    POJ3233:Matrix Power Series(矩阵快速幂+二分)
    矩阵快速幂(转载)
    素数筛法模板
    快速幂取模算法
    hdu1286(找新朋友)&&POJ2407Relatives(欧拉函数模版题)
    判断两线段相交
    POJ3070:Fibonacci(矩阵快速幂模板题)
    HDU1575:Tr A(矩阵快速幂模板题)
  • 原文地址:https://www.cnblogs.com/thewaytotheway/p/12847251.html
Copyright © 2020-2023  润新知