四轴起飞时，发出触发信号使导航模块开始工作，同时读取ICM20602的加速度计、陀螺仪数据，对数据卡尔曼滤波后姿态解算，对角度与角速度采取串级PID调节。控制系统算法设计主要有ICM20602滤波算法，姿态解算算法、串级PID控制算法和定高部分控制算法。碍于篇幅所限，下面介绍最重要的串级PID控制算法和定高部分控制算法。地理坐标系中重力的水平分量为零，仅用三轴陀螺仪和三轴加速度计无法计算出航向角，由于巡线机器人保持稳定飞行只需要横滚角（roll）和俯仰角（pitch），所以四元数转换成欧拉角。定高控制算法采用的是增量式PID控制，定高控制的输出最后与姿态控制的输出叠加到四个电机的控制中。数据滤波使用的是低通滤波，采用近三次的平均值。为了防止姿态对激光测距的影响及减小高度控制对姿态控制的干扰使用欧拉角来校正高度值，即Hight=(float)Hight*(cos(roll)* cos(pitch))。将四元数转换后的欧拉角与陀螺仪测出来的角速度进行串级PID控制，其中欧拉角作为外环，角速度作为内环。外环的PID以及内环的PD设定值为测试数据值。由于内环的角速度控制不需要无静差,所以内环采用PD控制,为防止测量的误差造成较大影响,外环积分需要限幅。
标签： 传感器
上传时间： 2022-06-24
上传用户：默默
本书是作者多年从事算法研究的经验总结。书中所有案例均因国内各大 MATLAB 技术论坛网友的切身需求而精心设计，其中不少案例所涉及的内容和求解方法在国内现巳出版的MATLAB书籍中鲜有介绍。本书采用案例形式，以智能算法为主线，讲解了遗传算法、免疫算法、退火算法、粒子群算法、鱼群算法、蚁群算法和神经网络算法等最常用的智能算法的 MATLAB实现。本书共给出30个案例，每个案例都是一个使用智能算法解决问题的具体实例，所有案例均由理论讲解、案例背景、MATLAB 程序实现和扩展阅读四个部分组成，并配有完整的原创程序，使读者在掌握算法的同时更能快速提高使用算法求解实际问题的能力。
上传时间： 2022-07-04
上传用户：
matlab数学建模算法全收录 超清书签版
上传时间： 2013-05-15
上传用户：eeworm
视频图像格式转换芯片的算法研究
上传时间： 2013-05-25
上传用户：eeworm
模拟电子技术基础（第四版）课件 康华光主编 PPT格式
上传时间： 2013-05-15
上传用户：eeworm
机械技术应用基础：机械设计四合一
上传时间： 2013-06-08
上传用户：eeworm
美河提供.C.参考大全第四版
标签：
上传时间： 2013-04-15
上传用户：eeworm
精通：VISUAL C++指纹模式识别系统算法及实现_0
上传时间： 2013-06-01
上传用户：eeworm
21天学通C++(第四版)
标签：
上传时间： 2013-06-03
上传用户：eeworm
VISUAL+C++指纹模式识别系统算法及实现_0
上传时间： 2013-04-15
上传用户：eeworm
