风力摆_兵器核科学_工程科技_专业资料

《风力摆_兵器核科学_工程科技_专业资料》由会员上传分享，免费在线阅读，更多相关内容在教育资源-天天文库。

1、风力摆控制系统（B题）摘要本系统为由STM32单片机控制模块、姿态采集模块、风力摆模块、液晶显示模块、人机交互系统以及风力摆机械结构组成的闭环控制系统。MPU6050采集风力摆姿态角，单片机处理姿态角数据后通过PID精确算法调节直流风机以控制风力摆。本系统实现了风力摆在仅受直流风机为动力控制下快速起摆、画线、恢复静止的功能，并能准确画圆，且受风力影响后能够快速恢复画圆状态，具有很好的鲁棒性。另外，本系统具有良好的人机交互界面，各参数及测试模式可由按键输入并通过液晶显示，智能性好，反应速度快。关键词：PID算法MPU6050STM32单片机人机交互1、系统

2、方案本风力摆控制系统主要包括单片机控制模块、电源模块、姿态采集模块、风力摆模块、液晶显示模块、人机交互系统以及风力摆机械结构组成。风力摆由万向节连接碳杆再连接风机组成。位于碳杆最下方的姿态采集模块不断采集风力摆当前姿态角，并返回单片机。单片机控制液晶显示姿态角数据并处理数据后通过控制PWM波占空比控制风机转速，实现对风力摆的控制。本系统结构框图如图1所示。姿态采集模块风力摆模块单片机系统人机交互系统液晶显示模块1.1风力摆运动控制方案的选择与论证方案一：采用2只直流风机作为动力系统。采用2只风机并排同向而立，分别位于摆杆两侧，通过控制风机转速控制风力摆使

3、激光笔画线画圆。此方案风力摆负载轻，但风力摆摆动过程中状态微调和快速静止不易实现。方案二：采用3只直流风机作为动力系统。三只风机为等边三角形三边，相背而立，互成120°夹角。此方案相对于方案二在控制风力摆转动过程中状态微调方面有提升，但自成三角形，相邻两风机夹角过大，依旧不利于精确控制风力摆状态。方案三：采用4只直流风机作为动力系统。四只风机取一边靠于摆杆，朝向成顺时针排列，通过控制四只风机转速控制风力摆当前状态。此方案风力摆负载最重，但对于控制风力摆状态最为精确，且动力最足。综合上述比较，考虑系统的快速工作以及精确控制，本系统采用方案三。1.2电源方案

4、的论证与选择方案一：使用单电源接自制线性直流稳压源模块。单电源同时给控制系统和风机供电，方案简单易操作。但风机转动过程中不仅会给电源带来纹波，而且产生反电压容易使单片机被烧毁。且单电源工作负载大，耗电快。方案二：采用双电源供电。风机驱动电源和控制电源分开，控制电机部分通过光耦隔离。电机使用12V锂电池供电，单片机控制系统用另一块电池接线性1直流稳压源模块供电。此方案可确保系统的稳定性，且满足了系统对供电需求。综合上述比较，考虑系统的安全性、稳定性以，本系统采用方案二。1.3角度测量方案的选择与论证方案一：只测量风力摆关于静止状态时的偏转角。采用二维平面内

5、角位移传感器测量风力摆转动时关于静止状态时的偏转角，通过控制该偏转角实现对流风机的控制。该方案软件处理繁琐，且二维平面内的角位移传感器不利于测量风力摆的空间位置，不利于实现对风力摆的精确控制。方案二：选用双轴倾角传感器模块LE-60-OEMLE-60-OEM，测量重力加速度变化，转为倾角变化，可测量双向。具有稳定性高、低功耗、结构简单等优点。响应速度为5Hz。它可以测量平衡板与水平方向的夹角，x,y方向可以测，但z轴不可测。且操作复杂，软件处理难度大。方案三：采用三维角度传感器。用三维角度传感器时刻测量风力摆当前姿态，通过处理采集的姿态角数据控制风机带动

6、风力摆运动。此方案可精确测量风力摆当前姿态，实现对风力摆的精确控制。综合比较以上两个方案，本系统选择方案三。1.4控制算法的选择方案一：采用模糊控制算法,模糊控制有许多良好的特性,它不需要事先知道对象的数学模型,具有系统响应快、超调小、过渡过程时间短等优点，但编程复杂，数据处理量大。方案二：采用PID算法，按比例、积分、微分的函数关系,进行运算,将其运算结果用以输出控制。优点是控制精度高,且算法简单明了。对于本系统的控制已足够精确，节约了单片机的资源和运算时间。综合比较以上两个方案，本系统选择方案二。2.系统理论分析与计算2.1风力摆状态的测量与计算采用

7、高精度的陀螺加速度计MPU6050不断采集风力摆姿态角数据。MPU6050集成了3轴MEMS陀螺仪，3轴MEMS加速度计，以及一个可扩展的数字运动处理器DMP。MPU6050和所有设备寄存器之间的通信采用400kHz的I2C接口，实现高速通信。且内置的可编程卡尔曼滤波器，采用最优化自回归数据处理算法精确测量风力摆当前姿态角。MPU6050对陀螺仪和加速度计分别用了三个16位的ADC，将其测量的模拟量转化为可输出的数字量，通过DMP处理器读取测量数据然后通过串口输出。22.2风力摆运动控制的分析风力摆采用4只45W的直流风机为动力驱动系统。姿态采集模块采集

8、风力摆当前姿态角，单片机处理姿态角信息调节输出PWM的占空比，控制四只风机的工作