无人机运动学控制中的坐标系,及惯性坐标系与机体坐标系之间的矩阵转换 欧拉角 |
您所在的位置:网站首页 › 二旋翼无人机飞行视频 › 无人机运动学控制中的坐标系,及惯性坐标系与机体坐标系之间的矩阵转换 欧拉角 |
一、无人机控制中的坐标系 无人机运动学中,有三种需要了解的坐标系 1.1、地球中心坐标系(ECEF) 地球中心坐标系,即坐标系原点位于地心。X轴通过格林尼治线和赤道线的交点,正方向为原点指向交点方向。 Z轴通过原点指向北极。 Y轴与X,Z轴构成右手坐标系。 而将该坐标系下的点,用GPS坐标表示出来即为WGS-84坐标系,其中在WGS-84坐标系中,X轴指向BIH(国际时间服务机构)1984.0定义的零子午面(Greenwich)和协议地球极(CTP)赤道的交点。Z轴指向CTP方向。Y轴与X,Z轴构成右手坐标系GPS可以获得在WGS-84中的速度向量,为了方便使用速度向量进行无人机控制,我们要把它转换在无人机所在位置的“平面坐标系”。 1.2、NED坐标系 由于地心坐标系建立产生的GPS信号是以前面的形式存在,而现实无人机控制中需要在平面,因此引入了NED坐标系,如图绿色部分即为NED坐标系。通常我们以NED为确定无人机位姿的参考坐标系,惯性系。 NED坐标系是在导航计算时使用的坐标系。向量分别指向北,东,地,因此NED坐标系也经常称为北东地坐标系。也就是NED坐标系的三个方向是不变的。 当无人机搜星满足起飞条件1,则该点所确定 1.3、机体坐标系 机体坐标系与飞行器固联,坐标系符合右手法则,原点在飞行器重心处,x轴指向飞行器机头前进方向,y轴由原点指向飞行器右侧,z轴方向通过x,y由右手法则确定。机体坐标系是无人机惯性导航的基础坐标系,IMU中获得的加速度状态信息就是该坐标系下的数值。当我们获取IMU输出的x轴加速度信息时不能直接应用在NED坐标系下。 无人机中的坐标转换,即为NED坐标系(惯性系)与机体坐标系之间的转换。 二、无人机IMU单元 IMU单元,惯性测量单元,用于测量物体三轴姿态角(角速率)以及加速度的装置。 IMU由陀螺仪和加速度计组成,其中: 陀螺仪:检测载体相对于导航坐标系的角速度信号; 加速度计:三个单轴的加速度计检测物体在坐标系独立三轴的加速度信号 其精度直接影响到惯性系统的精度。 三、无人机中矩阵的确定与变换 3.1、无人机的姿态 一个空间中的无人机可通过给定位置和方向而完全描述,令
通过坐标系 为了确定无人机的方向,简便的方法即为加入一个附在无人机机身上的坐标系, 3.2、旋转矩阵(注:3.2中的旋转矩阵与3.1上式各分量定义不一致,可对比根据式子定义来理解) 将描述无人机方向的 这里第三个矩阵中,由于x为单位向量(1,0,0),故与向量 上诉矩阵R被称为旋转矩阵。 由于 R是一个正交矩阵,故 如果坐标系是右手法则则det(R)=1,若为左手法则确定则det(R)=-1。 3.2.1、基本旋转(旋转回原坐标系下所需要相乘的矩阵,也可以理解为旋转量) 坐标系 假定坐标系 因此,绕z轴旋转的矩阵可表述为 同样,按此方法可表述按x轴和按y轴旋转时的旋转矩阵 对于描述空间中容易一个旋转,这些矩阵将会是非常有用的。 通过上诉的矩阵,可很容易的证明,旋转矩阵有 3.2.2、一个向量的旋转表述 为了进一步理解旋转矩阵的几何意义,将两坐标系原点重合,即 其中, 即 旋转矩阵R表述了向量从矩阵 例3.1: 设两坐标系具有相同原点,且通过按z轴旋转 由此可见,其坐标转换即为 3.2.3 一个向量的旋转 上一节中,利用旋转矩阵实现了向量从 例3.2: 在下图坐标系下,令位于xy平面的向量 即可以简单的用旋转矩阵表示为 因此,可以得到一个旋转矩阵,首先描述两个坐标系之间的转换和两个坐标系向量之间的转换,此外还可以实现在同一坐标系下向量的旋转。 3.3、旋转矩阵的组合 为了得到旋转矩阵的组合规则,思考一个向量在不同坐标系下的表述是有用的。令 首先,思考坐标系2下 相似地,有 上诉三式中,将第一和第三代入第二式,可得关系 上一关系式可以表述为连续旋转的组合。思考一个坐标系最初为 (1)基于现有坐标系根据 (2)经过第一步的旋转,已于 (这里这样表述可能大家感到不甚理解,不是由 可注意到所有的旋转可表示为一系列微小旋转的组合。每一个旋转定义为基于之前的一个坐标系,将要发生转换的坐标系称为当前坐标系。连续旋转的组合是通过旋转矩阵自右乘来实现的,回顾 连续的旋转也能够详述为不断的参考他们至最初的坐标系,在这种情况下,旋转可以被发生基于一个固定的坐标系。令 其中 旋转组合的一个重要问题是矩阵的产生是不可交换的。鉴于这一点,能够推断两个旋转矩阵一般是不能交换的并且它的组成取决于单个旋转的顺序。 例3.3: 思考在一个物体上系有坐标系,下图展示了该物体对于当前坐标系改变旋转次序的两次旋转变化,可以明显的注意在两种情形到最后物体的方向是不同的。 4、欧拉角 旋转矩阵对于坐标系的方向给予了一个过多的描述;事实上,由于正交矩阵的性质,所具有的九个特征元素收到六个约束,彼此之间并非独立的。这意味着对于描述一个刚性物体的方向有三个参数即是足够的。 (六个约束详解地址:3阶正交矩阵只有三个自由度/自由向量 欧拉角六个约束问题_国庆的博客-CSDN博客) 依据三个参数组成的方向描述为一个最小表示,一个最小表示能够被获得通过使用一个三个角度的集合 4.1、RPY角 RPY(最初起源于航海领域,他们属于(ZYX)角,也被称为Roll-Pitch-Yaw(滚转-俯仰-偏航),它能表述一个飞行器在空中姿态的变化。角 翻滚-俯仰-偏航角度的获取可包括以下: 该图只为了让大家有一个具体空间角度变化的了解,将坐标系轴线位置设置不同则滚仰偏定义对应的轴线可能不同,如以下,定义中,设置绕x轴旋转为偏航,绕y轴旋转为俯仰,绕z轴旋转为翻滚,结合坐标系,判断一下坐标系在飞机上怎么固定呢? 机头方向指向z,x正方向为机身向上方向,如下图: (1)绕z轴旋转角度 (2)绕y轴旋转角度 (3)绕x轴旋转角度 坐标系旋转的结果可由基于固定坐标系旋转的组合获得,能够通过基本旋转矩(上3.2.1)阵自左乘获得。 即 由以上 通过比较 若 若 其中 4.2、无人机中的欧拉角 经过上诉的部分已经将旋转矩阵方面的知识描述完毕,接下来为具体在无人机运用上的矩阵变换。 无人机中我们选择旋转z轴产生的为偏航角,旋转y轴产生的为俯仰角,旋转x轴为滚转角。 上文3.2.1中讲述了三种基本旋转矩阵,上述的旋转矩阵R可将变换后的位移、速度、力转换为变换前原坐标系下的位置、速度、力,由此我们如果获得无人机相对于惯性系(NED坐标系)的角度,即可得到在惯性系下的运动。当然我们也可以设定无人机的机体坐标系为原始坐标系,这时如果想要获得在惯性系下的相关量,则需要乘上旋转矩阵的逆,上面我们有旋转矩阵的装置为旋转矩阵的逆,固有如下:
4.3、无人机中的万向锁 陀螺仪的结构为一根轴线穿过一个圆盘,且圆盘处于高速旋转状态,为陀螺仪的转子。根据陀螺的定轴性,陀螺的自转轴即竖轴在惯性空间内的方向保持不变 |
CopyRight 2018-2019 办公设备维修网 版权所有 豫ICP备15022753号-3 |