一.姿态结算(匿名版程序)
首先,程序中一般用了两种求解姿态的方法,一种为欧拉角法,一种为四元数法
(1)欧拉角法静止状态,或者总加速度只是稍微大于g 时,由加计算出的值比较准确。使用欧拉角表示姿态,令Φ,θ 和Φ代表ZYX 欧拉角,分别称为偏航角、俯仰角和横滚角。载体坐标系下的加速度( axB,ayB , azB) 和参考坐标系下的加速度(a xN, a yN, a zN) 之间的关系可表示为(1)。其中c 和s 分别代表cos 和sin。axB,ayB,azB 就是mpu 读出来的三个值。
这个矩阵就是三个旋转矩阵相乘得到的,因为矩阵的乘法可以表示旋转。
飞行器处于静止状态,此时参考系下的加速度等于重力加速度
声明:本文内容及配图由入驻作者撰写或者入驻合作网站授权转载。文章观点仅代表作者本人,不代表电子发烧友网立场。文章及其配图仅供工程师学习之用,如有内容侵权或者其他违规问题,请联系本站处理。 举报投诉
全部0条评论
快来发表一下你的评论吧 !