文档介绍：该【风力摆控制系统论文 】是由【胜利的喜悦】上传分享，文档一共【14】页，该文档可以免费在线阅读，需要了解更多关于【风力摆控制系统论文 】的内容，可以使用淘豆网的站内搜索功能，选择自己适合的文档，以下文字是截取该文章内的部分文字，如需要获得完整电子版，请下载此文档到您的设备，方便您编辑和打印。1风力摆控制系统摘要本文设计和实现的风力摆控制系统一种双输入,双输出闭环控制系统。系统通过调节风机转速实现风力摆按照一定规律运动,激光笔画出所要求的运动轨迹,而以风力摆的摆角作为调节风机转速的参数。本系统以STM32F103单片机为控制核心,包括电源模块,单片机控制模块、按键选择模块、声光报警模块、风机驱动模块、角度检测模块。由按键选择风力摆的工作模式,单片机通过驱动控制风机转速,改变风力摆的摆角。陀螺仪检测风力摆的摆角并将数据反馈给单片机,对此数据进行卡尔曼滤波和PID控制算法处理后,单片机声光报警,输出PWM波控制驱动调节风机转速。软件部分应用C语言实现系统的基本功能。关键词:风力摆;陀螺仪;卡尔曼滤波;,包括电源模块,单片机控制模块、按键选择模块、声光报警模块、风机驱动模块、角度检测模块。采用直流开关电源给驱动和单片供电,驱动将电压稳压后给风机供电。由按键选择风力摆的工作模式,单片机通过ULN2003驱动模块控制风机转速,改变风力摆的摆角。MUP—6050陀螺仪检测风力摆的摆角并将数据反馈给单片机,对此数据进行卡尔曼滤波和PID控制算法处理后,单片机声光报警,输出PWM波控制驱动模块调节风机转速。图1-1为系统总方案设计框图。图1-:采用STC8051单片机作为本系统主控器。51系列单片机功耗较高,8位微型处理器运算速度慢,5个中断源,无硬件乘法器,片内资源少。但价格低廉,使用简单。方案二:。MSP430F149单片机德州仪器开发的一种超低功耗微控制器,它是一款16位单片机,内含12位ADC,运算速度较快,价格略贵。方案三:采用STM32F103单片机作为本系统主控器。STM32系列是基于专为要求高性能、低成本、低功耗的嵌入式应用专门设计的ARM?。STM32F103是一款常用的增强型系列微控制器。STM32F103增强型系列使用高性能的ARM/Cortex-M3/32位的RISC内核,运算速度极快,精度高,执行能力强,中断源多。3综上三种方案,STM32F103单片机比其他两个单片机运算速度都快,精度更高,处理能力强,功耗低,且价格适中,能大大降低系统复杂度,提高了系统的性价比,因此我们选方案二。:采用导电塑料角位移传感器WDS35D。WDS35D传感器采用特殊形状的转子和绕线线圈,模拟线性可变差动传感器的线性位移。WDS35D测量范围为0°~360°,输出电压范围输入电压有关,输出精度为1mv,°,可以实现对角位移的精确测量。但WDS35D操作复杂,不易控制,价格较高,适用于对角度精度和稳定性要求极高的复杂控制系统。方案二:采用MPU6050陀螺仪模块。MPU-60X0?是全球首例9?轴运动处理传感器。它集成了3?轴MEMS?陀螺仪,3?轴MEMS加速度计,以及一个可扩展的数字运动处理器DMP,MPU—6050对于角度的采集精度高,易于操作。综上两种方法,MPU—6050和WDS35D可都以进行精确测量,但MPU—6050陀螺仪模块体积小、精度高、采集速度快、操作简单,而WDS35D操作复杂,价格较高,不实用,故我们选择方案二。:采用以L298N为主芯片的驱动电路。L298N是ST公司生产的一种二相和四相电机的专用驱动器。L298N是可以承受高压大电流的双全桥式驱动器,可驱动直流和步进电机,其输出电流大,功率大,一次可以同时控制两个电机,价格适中,是比较常见和实用的电机驱动模块。方案二:采用ULN2003驱动模块。ULN2003是高压大电流达林顿晶体管阵列系列产品,可直接驱动继电器等负载,其操作简单,易于控制,具有电流增益高、工作电压高、温度范围宽、带负载能力强等优点。综上两种方案,我们采用ULN2003模块驱动。按照题目要求我们选择的轴流风机所需驱动电压较小,而以L298N为主芯片的驱动电路驱动电压过大,而ULN2003模块的驱动电压刚好适用,故我们选择方案二。42系统理论分析及计算系统要实现风力摆的规律运动,使激光笔画出运动轨迹,单片机对与角度数据的处理是非常重要的。本系统中由陀螺仪检测风力摆的摆角,陀螺仪共检测到风力摆3组角速度、重力加速度数据,由于此数据为非线性信号,所以要先采用低通滤波进行信号处理,然后对采集数据进行四元数与欧拉角的转换,转换后的数据经卡尔曼滤波得到易于控制的线性信号,最后由PID控制算法计算得到单片机所应该输出的PWM波,由此调节风机转速,实现风力摆的规律运动。,但此数据为非线性信号,不能直接用于控制,需要进行四元数与欧拉角的转换。四元数是简单的超复数,复数是由实数加上虚数单位i组成。四元数就是由一个实数加上三个元素i、j、k组成,四元数一般可表示为a+bi+cj+dk,且。假设刚体坐标系为b系,地理坐标系为R系,则地理坐标系R到刚体坐标系b的坐标变换为:欧拉角是用来唯一地确定定点转动明体位置的三个一组独立角参量,由章动角、进动角和自转角组成,已知任一瞬时的某一角的各个分量,也可求出其他两角时间的关系,因而也就决定了刚体的运动。四元数转换成欧拉角的变换为:,通过系统输入输出观测数据,对系统状态进行最优估计的算法。由于观测数据中包括系统中的噪声和干扰的影响,所以最优估计也可看作是滤波过程。数据滤波是去除噪声还原真实数据的一种数据技术,滤波在测量方差已知的情况下能够从一系列存在测量噪声的数据中,估计动态系统的状态。在本系统中以风力摆所有过去的摆角输入和扰动作用最小参数的集合为基础对未来摆角数据进行预测,从输出和输入观测数据求出的系统状态最优估计,能够与未来的输入与系统的扰动一起确定风力摆摆角的整个变化。非线性数据经过卡尔曼滤波作用后可以大幅度提高控制精度,减少系统误差,增加系统的稳定性。,它将给定值与实际输出的偏差的比例、积分、微分通过线性组合构成控制量,对控制对象进行控制。当被控对象的结构和参数不能完全掌握或得不到精确的数学模型,控制理论和其他技术难以采用时,系统控制器的结构和参数必须依靠经验和现场调试来确定,这时应用PID技术最为方便,即使当我们不完全了解一个系统和被控对象,或是不能通过有效的测量手段来获得系统参数时,也适合采用PID控制技术。在本系统中被控对象为风力摆,其数学模型以及理论计算并不容易,故我们采用位PID控制算法对经卡尔曼滤波后的数据进行计算。其中P为比例系数;I为角度误差的积分系数;D为微分系数。OUTPUT=P*Error+D/dt*[Error(n)-Erro(n-1)]系统控制框图如图2-1所示。图2-,STM32F103是ST旗下的一款常用的增强型系列微控制器,STM32F103增强型微控制器系列使用高性能的ARM/Cortex-M3/32位的RISC内核,具有处理能力强,功耗低,执行能力强,中断源多等优点。在整个系统中由STM32F103单片机控制实现整个功能,包括陀螺仪对摆角数据的采集,卡尔曼滤波处理非线性信号,PID控制算法计算、风机的驱动以及声光报警等功能。系统采用C语言进行编程,C语言生成目标代码质量高,程序执行效率高,更易控制系统。图3-1为STM32F103单片机最小系统电路图。图3-,LM2596为可调式的开关电源,、5V、12V电压,可调版本可以输出小于37V的各种电压。具有很好的线性和负载调节特性。LM2596将输出电压同内部基准稳压值进行比较,通过放大器调节去芯片内部振荡器的输出占空比,从而稳定输出电压,稳定输出的电压经电容进行平滑滤波。在实际操作中通过调节R2改变输入电压,经LM2596稳压得到所需电压。、5V、7V电压,分别给单片机、驱动、声光报警模块、风机供电。电源模块电路如图3-2所示。图3-。单片机对角度数据处理后输出PWM波控制ULN2003驱动模块。ULN2003是高耐压、大电流达林顿陈列,由七个硅达林顿管组成。,在5V的工作电压下它能与TTL和CMOS电路直接相连,可以直接处理原先需要标准逻辑缓冲器来处理的数据。?在本系统中所选的轴流电机所需驱动电压较小,ULN2003驱动模块驱动电压刚好适用,ULN2003实际为多个NPN三极管,相比其他驱动模块,ULN2003操作简单,易于编程。驱动模块电路如图3-3所示。图3-。按照题目要求运动达到要求时要进行一定的声光提示,题目要求不高,蜂鸣器和LED灯完全能够达到要求。在此模块中系统采用三极管9012作为开关控制LED灯亮、蜂鸣器报警。三极管9012为NPN型三极管,当运动轨迹达到要求时,单片机给NPN9012基极一个低电平时,三极管导通,LED灯亮、蜂鸣器报警。在电路中1N4007二极管主要起保护电路作用。驱动模块电路如图3-4所示。图3-,采用C语言编程。程序主要起导向和决策的作用,它控制整个系统稳定协调的运作。在本系统中,对各个模块的调试采用分步进行,确定各个模块的独立工作完整性,然后再对整个系统所有模块进行完糅合,使其完成系统的所有功能。由按键选择风力摆的工作模式,单片机通过控制风机转速改变风力摆的摆角。陀螺仪检测风力摆摆角将数据反馈给单片机,采用低通滤波进行非线性信号处理,然后进行四元数转换,经卡尔曼滤波得到易于控制的线性信号,最后由PID控制算法得到PWM波,由此调节风机转速,实现风力摆的规律运动。8系统主流程图如图3-5所示。图3-5系统主流程图中断流程图如图3-6所示。图3-,测试所用仪器如表4-1所示。表4-,15秒内激光笔是否能够画出50㎝的直线段,是否能够画出自由设定30~60㎝的自由线段,风力摆是否能够按照设定运动,以及将风力摆拉起30°~45°时能否静止,共测试6组数据,如表4-2所示。表4-2摆杆角度测试结果次数能否画出50㎝的直线段能否画出自由设定30~60㎝,本系统基本完成了基础部分的要求,完成情况如表4-3所示。表4-3测试结果题目要求完成情况基本部分(1)从静止开始,15s内控制风力摆做类似自由摆运动,使激光笔稳定地在地面画出一条长度不短于50cm的直线段,其线性度偏差不大于±,并且具有较好的重复性。完成续表4-310