四旋翼飞行器程序..doc

PAGE 3 - 四旋翼自主飞行器(B题) 摘要 系统以R5F100LE作为四旋翼自主飞行器控制的核心，由电源模块、电机调速控制模块、传感器检测模块、飞行器控制模块等构成。飞行控制模块包括角度传感器、陀螺仪，传感器检测模块包括红外障碍传感器、超声波测距模块、TLS1401-LF模块，瑞萨MCU综合飞行器模块和传感器检测模块的信息，通过控制4个直流无刷电机转速来实现飞行器的欠驱动系统飞行。在动力学模型的基础上，将小型四旋翼飞行器实时控制算法分为两个PID控制回路，即位置控制回路和姿态控制回路。测试结果表明系统可通过各个模块的配合实现对电机的精确控制，具有平均速度快、定位误差小、运行较为稳定等特点。 目 录 TOC \o 1-3 \h \z \u HYPERLINK \l _Toc366343362 1 系统方案论证与控制方案的选择 PAGEREF _Toc366343362 \h - 2 - HYPERLINK \l _Toc366343363 1.1 地面黑线检测传感器 PAGEREF _Toc366343363 \h - 2 - HYPERLINK \l _Toc366343364 1.2 电机的选择与论证 PAGEREF _Toc366343364 \h - 2 - HYPERLINK \l _Toc366343365 1.3 电机驱动方案的选