四轴起飞时，发出触发信号使导航模块开始工作，同时读取ICM20602的加速度计、陀螺仪数据，对数据卡尔曼滤波后姿态解算，对角度与角速度采取串级PID调节。控制系统算法设计主要有ICM20602滤波算法，姿态解算算法、串级PID控制算法和定高部分控制算法。碍于篇幅所限，下面介绍最重要的串级PID控制算法和定高部分控制算法。地理坐标系中重力的水平分量为零，仅用三轴陀螺仪和三轴加速度计无法计算出航向角，由于巡线机器人保持稳定飞行只需要横滚角（roll）和俯仰角（pitch），所以四元数转换成欧拉角。定高控制算法采用的是增量式PID控制，定高控制的输出最后与姿态控制的输出叠加到四个电机的控制中。数据滤波使用的是低通滤波，采用近三次的平均值。为了防止姿态对激光测距的影响及减小高度控制对姿态控制的干扰使用欧拉角来校正高度值，即Hight=(float)Hight*(cos(roll)* cos(pitch))。将四元数转换后的欧拉角与陀螺仪测出来的角速度进行串级PID控制，其中欧拉角作为外环，角速度作为内环。外环的PID以及内环的PD设定值为测试数据值。由于内环的角速度控制不需要无静差,所以内环采用PD控制,为防止测量的误差造成较大影响,外环积分需要限幅。
标签： 传感器
上传时间： 2022-06-24
上传用户：默默
eeworm.com VIP专区 单片机源码系列 37资源包含以下内容：1. RS485使用手册与指南.pdf2. 基于51单片机应用的电子万年历设计.doc3. DS1307中文说明.doc4. 光电隔离器6N137和6N136的使用.pdf5. MSP430系列单机实用C语言(新).pdf6. 51单片机实现RS485.doc7. Multisim进行单片机仿真实践.pdf8. 基于c51小车测速的程序设计.zip9. USMART V2.0使用说明_AN1101.pdf10. 51单片机教程.rar11. ALIENTEK MINISTM32 扩展实验9 USMART应用.rar12. PIC单片机C语言学习教程.pdf13. 深入浅出AVR(ATMEGA4888).pdf14. PIC烧录器.doc15. SiriuS开发板附原理图与部分源代码.rar16. 自制ICD2-USB全套资料下载（原理图+PCB+程序）.rar17. MSP430系列单片机实用C语言程序设计.pdf18. MSP430经典讲解.pdf19. MSP430系列单片机实用C语言.pdf20. PCB相关经验.pdf21. HC-SR04超声波测距模块说明书.pdf22. PCB板基础知识、布局原则、布线技巧、设计规则.doc23. MSP430f149程序框架.doc24. 单片机控制汽车语音技术.doc25. 万年日历设计.rar26. MSP430应用技术资料.pdf27. 精典由入门到精通吃透PID.pdf28. MSP430单片机通用系统.pdf29. RA8875中文规格书.pdf30. STC单片机选型.pdf31. 4x4矩阵键盘程序.doc32. 循迹小车电路图.pdf33. 51单片机串口通信.ppt34. 自动机器人小车的完整电路图.pdf35. 电子时钟设计(完美实现最终版).doc36. 51单片机寄存器.pdf37. uln2003芯片中文资料.pdf38. 单片机C语言程序设计实训100例--基于8051+PROTEUS仿真1.doc39. 巨经典好书：单片机C语言程序设计实训100例——基于8051+Proteus仿真.pdf40. 51单片机C语言编程技巧.pdf41. 51单片机及C语言入门源代码.rar42. CCS安装与应用.doc43. 单片机外围电路图.pdf44. 高质量C++/C编程指南.zip45. msp430图形显示库使用说明SW-GRL-UG-4781.pdf46. 详细的单片机C语言学习资料.rar47. 2009年春浙江省高等学校.doc48. MSP-EXP430G2_Schematic+Silkscreen(msp430G2下列电路图).pdf49. 51单片机学习资料.rar50. 手把手教你学PIC单片机C语言教程.pdf51. 单片机主课件.rar52. 单片机多功能调试助手V1.5.8.rar53. 程序设计实训100例(最全).doc54. wave6000单片机.exe55. 基于89c2051单片机的电子闹钟.doc56. 面向新手的AVR开发工具及基本知识_中文.pdf57. launchpad msp430官方示例.zip58. STM8使用小经验.docx59. 51单片机C语言编程实例.pdf60. 8路遥控抢答器.rar61. STC12单片机中文手册.pdf62. 基于89C51放电法测高阻数据的采集与处理.rar63. MSP430_FAEs_Training_03202008.pdf64. 基于AT89S52单片机的无线抢答记分系统的设计与制作.rar65. MSP430F5529中文_120410.ppt66. 基于AVR单片机的轮胎模具内径测量系统.rar67. AVR C库函数介绍.pdf68. USB下载软件以及驱动程序.rar69. MSP430自学手册3.1.pdf70. PIC单片机ICD2.5USB入门使用教程.pdf71. 51开发板（原理图）.pdf72. 单片机C语言设计实例.pdf73. 《单片机基础外设 九日通》.rar74. 基于AT89C51的智能化转速测量仪的设计.rar75. 单片机实验与实践教程.pdf76. 51单片机的中断控制.pdf77. 电压表课程设计.rar78. PID控制直流电机速度.doc79. 电子元件基础教程.doc80. MSP430单片机用12864液晶绘制DS18B20温度曲线源代码.rar81. 诺基亚3310手机屏中文手册.pdf82. zlg7289b应用.pdf83. LCD点阵12864画温度曲线(51单片机绘制温度曲线).rar84. 从单片机初学者迈向单片机工程师.pdf85. 工作笔记-TC35模块调试记录.doc86. EDID-BOARD资料.pdf87. 103H5205 单极步进电机.pdf88. 基于51单片机16x64点阵设计报告.docx89. CD4511引脚图及功能文档.doc90. 51单片机原理图.pdf91. 基于单片机的电阻、电容、电感测试仪.doc92. 单片机高级外设.zip93. 用Mega32+VS1003做的MP3(FAT32文件系统浏览)——源代码.rar94. 可以显示-55-125之间的温度的源程序和原理图.doc95. DS1302中文资料.pdf96. 用Mega32+VS1003做的MP3(FAT32文件系统浏览)——PCB原理图.rar97. [原创]经典4乘4键盘程序下载（C语言）.rar98. 电子元器件识别(含图片).pdf99. 逐日太阳能发电路灯照明系统设计.zip100. C语言算法速查手册.rar
上传时间： 2013-04-15
上传用户：eeworm
eeworm.com VIP专区 单片机源码系列 60资源包含以下内容：1. JMDM-MB01单片机主板使用说明书.pdf2. KEIL uvision3中文版附注册机.rar3. PLC与气压控制.pdf4. 单片机C语言中指针的应用.pdf5. ModbusV1.024（Modbus调试精灵-调试专用工具.rar6. EASY51单片机学习套件用户手册V1.0.pdf7. GP常见问题.pdf8. 单片机实时数据采集系统设计.pdf9. 抛砖引路单片机.pdf10. 单片机控制电机正反转.pdf11. “51单片机实验”教学大纲.pdf12. 基于单片机的糊化测控系统.pdf13. 提高PLC控制系统可靠性的措施.pdf14. 浅谈单片机系统的电磁兼容性设计.pdf15. SEMV-HC08AP简介.pdf16. AVR单片机的基本组成.pdf17. 51单片机中断系统详解.pdf18. 单片机遥控转向控制器.pdf19. 51单片机为什么常用11.0592MHz的晶振.pdf20. 51CPLD学习板实验指导书.rar21. 单片机温度控制系统的设计.pdf22. 第1章μPSD3200系列单片机概述.pdf23. MSP430单片机的开发及应用.pdf24. 机电复合型轮机管理人才培养方案的研究与探索.pdf25. P89C51Rx+/Rx2/66x系列单片机的在线编程.pdf26. 基于单片机嵌入式网络接入模块的设计与实现.pdf27. EM78系列单片机硬件结构.pdf28. 基于单片机和CPLD的频率测量研究.pdf29. 基于单片机的日历设计.pdf30. 单片机原理及应用实验教学大纲（课典）.pdf31. S08单片机开发工具包设计.pdf32. 基于单片机的涌流抑制器的设计与实现.pdf33. 74HC154译码器应用(基于8051+Proteus仿真).rar34. 基于单片机和LED的汽车照明系统设计.pdf35. 温湿度变送器.pdf36. 智能语音拨号报警系统.pdf37. SGV系列单片机三相整流移相调压模块使用说明.pdf38. Flash单片机自编程技术的探讨.pdf39. 基于AT89S8252 单片机的汽车瞬时燃油油量检测系统的设.pdf40. 单片机原理及应用教学改革实践.pdf41. 法宝级的EMC单片机编程技巧集锦.pdf42. 从MCS51 向AVR 的快速转换.pdf43. 单片机I/O口键盘扩展方法.pdf44. 基于单片机的智能稳压电源的设计.pdf45. PIC单片机移植资料.rar46. 基于PIC单片机的标签检测器.pdf47. 单片机控制在网板烘干线上的应用研究.pdf48. 基于C8051F单片机的移动式音乐喷泉设计.pdf49. STC单片机开发板使用说明.pdf50. 基于MEMS与单片机的西瓜成熟度无损检测系统的研究.pdf51. 基于单片机的倒车后视系统设计.pdf52. 基于单片机AT89C2051的九路多功能智力竞赛抢答器的设计.pdf53. 《单片机实验》教学大纲.pdf54. 基于80C51单片机的多路智能遥控节电器.pdf55. 柜机单片机控制系统使用说明和检测方法.pdf56. 《单片机技术》实验指导书.pdf57. MCS-51单片机木材干燥控制仪软硬件的设计.pdf58. HCS08/RS08集成开发环境设计与实现中文摘要.pdf59. Quick51实验指导书.pdf60. keil c51 v9.01 (C51单片机开发工具Kei.rar61. msp430汇编指南.pdf62. Keil C251设计软件 3.11 (4k代码限制).rar63. lpc2478完全使用手册.pdf64. Keil c51 v8.18 下载.rar65. 单片机(提高篇).rar66. 单片机外围线路设计.rar67. 单片机(入门篇).rar68. 单片机GSM短消息控件.zip69. 单片机自动巡线轮式机器人控制系统设计.rar70. 单片机实现智能荧光鉴伪.pdf71. 单片机用于温度采集与控制系统的设计.rar72. MT8870D DTMF解码芯片.pdf73. 51单片机Keil C语言入门教程.rar74. IC 卡保险箱.pdf75. AVR JTAG AVR仿真器.rar76. 简明python 教程.pdf77. AVR单片机的特点及其应用.pdf78. AVR STUDIO熔丝配置.rar79. ICCAVR自动下载程序.rar80. AVR ISP下载线使用说明.rar81. AVR单片机串行接口及应用.pdf82. AVRstudio入门.pdf83. 版权保护芯片ALPU的设计.pdf84. 采用MSP430设计的12位心电(ECG)放大器.pdf85. ICCAVR 入门.pdf86. TinyM0_Routine.zip87. 基于单片机烟感报警器的设计.doc88. 世界著名厂家单片机简介.pdf89. ZOPC_Server(ZLG通用OPC服务器)软件.rar90. 基于MAX3420的实时数据采集系统设计.pdf91. CiA 简介.pdf92. NDAM 配置软件 V2.07.zip93. 串行通信（UART）教程 ppt资料.rar94. CAN基本知识.pdf95. 基于RS485总线的PC机与多单片机系统的串行通信.pdf96. 一个单片机串行数据采集/传输模块的设计.doc97. 51LPC 微控制器以及三端双向可控硅简介.pdf98. 单片机入门的40个实验.doc99. PIC16系列单片机与PC机串行通信的软硬件实现.doc100. 《单片机与嵌入式系统解决方案》.pdf
上传时间： 2013-07-12
上传用户：eeworm
AVR单片机在线编程下载线电路图及HEX文件
上传时间： 2013-11-01
上传用户：bvdragon
自动机器人小车完整电路图
上传时间： 2014-12-26
上传用户：zhangjinzj
单片机智能小车巡迹壁障
上传时间： 2013-11-05
上传用户：chukeey
AVR单片机在线编程下载线电路图,PCB图及HEX文件 什么是AVR单片机？AVR单片机是什么意思？
上传时间： 2013-11-23
上传用户：笨小孩
口调试助手源程序\AVR单片机在线编程下载线电路图,PCB图及HEX文件.zip
上传时间： 2014-01-17
上传用户：ayfeixiao
这是本人在毕业课程设计制造的51单片机的仿真器,其中有电路图和上下位机的程序.PCB板走线图
上传时间： 2013-12-30
上传用户：坏坏的华仔
AVR USP下载线源码, 含电路图和印制版图
上传时间： 2013-12-26
上传用户：huyiming139
