[发明专利]一种四旋翼飞行器保持机体平衡的方法在审
申请号: | 201510705125.9 | 申请日: | 2015-10-27 |
公开(公告)号: | CN105259750A | 公开(公告)日: | 2016-01-20 |
发明(设计)人: | 刘刚强 | 申请(专利权)人: | 四川豪斯特电子技术有限责任公司 |
主分类号: | G05B13/02 | 分类号: | G05B13/02 |
代理公司: | 成都九鼎天元知识产权代理有限公司 51214 | 代理人: | 詹永斌 |
地址: | 621000 四川省*** | 国省代码: | 四川;51 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 四旋翼 飞行器 保持 机体 平衡 方法 | ||
1.一种四旋翼飞行器保持机体平衡的方法,包括姿态解算算法和姿态控制算法,其特征在于包括以下步骤:
姿态解算算法,
步骤一:首先定义姿态速度、计算周期、定义姿态解算误差的积分、初始化四元数,利用姿态解算函数分别对三个轴的角速度和加速度原始数据进行计算归一化,得到单位加速度;
步骤二:把四元数换算成方向余弦矩阵中的第三列的三个元素,根据余弦矩阵和欧拉角的定义,地理坐标系的重力向量,转到机体坐标系,就是当前的机体坐标参照系上,换算出来的重力单位向量;
步骤三:在机体坐标参照系上,加速度计测出来的重力向量与陀螺积分后的姿态来推算出的重力向量的误差向量,就是陀螺积分后的姿态和加速度计测出来的姿态之间的误差;误差向量仍旧是位于机体坐标系上,误差向量大小与陀螺积分误差成正比;
步骤四:将误差向量积分,用误差向量来修正陀螺零偏,通过调节加速度计修正陀螺仪积分姿态的速度参数,可以控制加速度计修正陀螺仪积分姿态的速度;
姿态控制,
采用两个串联起来的PID控制器构成串级PID控制系统,其中主调节器的输出作为副调节的给定值,主调节器的控制环称为外环,副调节器的控制环为内环,外环的控制周期为内环控制周期的两倍。
2.根据权利要求1所述的一种四旋翼飞行器保持机体平衡的方法,其特征在于计算周期为姿态解算时间的一半,姿态速度为500HZ。
3.根据权利要求1所述的一种四旋翼飞行器保持机体平衡的方法,其特征在于所述姿态控制中,姿态稳定时其姿态速度为零。
4.根据权利要求1所述的一种四旋翼飞行器保持机体平衡的方法,其特征在于所述串级PID控制系统采用角度外环和角速度内环组成的串级PID控制器。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于四川豪斯特电子技术有限责任公司,未经四川豪斯特电子技术有限责任公司许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201510705125.9/1.html,转载请声明来源钻瓜专利网。