基于IAP15W4K58S4的风力摆控制系统设计

Techniques of Automation & Applications | 1

基于IAP15W4K58S4的风力摆控制系统设计

刘翘楚1,郭鹏伟1,刘学明2

(1.中北大学朔州校区,山西 朔州 036000;2.国网山西省吕梁供电公司,山西 吕梁 033000)

摘 要:风力摆控制系统作为一种典型的自动化控制平台,近年来得到了广泛的研究。为了更科学合理地运用风力摆,设计并制

作了一套基于单摆物理模型的实物系统,为系统预设了定角度直线运动和圆周运动两种主要形式。对运动过程进行了线性化、离散化处理,将两种运动都分解为两个正交方向的简谐运动,利用莉萨如图形完成算法的设计。利用单片机的定时器产生系统的控制周期,在一个控制周期内完成采样、计算、输出、执行。试验结果表明,系统可以稳定、精确、快速地完成预设的目标动作,且抗干扰能力强,响应快。

关键词:简谐运动;PID 算法;伺服系统;IAP15W4K58S4

中图分类号:TP273 文献标识码:A 文章编号:1003-7241(2019)02-0001-04

Design of Wind Pendulum Control System

Based on IAP15W4K58S4

LIU Qiao-chu 1, GUO Peng-wei 1, LIU Xue-ming 2

( 1. Campus of Shuozhou, North University of China, Shuozhou 036000 China;

2. Stste Grid Lvliang Power Supply Company, Lvliang 033000 China )

Abstract: As a typical automatic control platform, wind pendulum control system is studied extensively in recent years. In order to

apply the wind pendulum more scientifically and rationally, a kind of object system based on simple pendulum physical model is designed and manufactured. The system has two main forms: fixed angle linear motion and circular motion. The motion process is linearized and discretized, and they are decomposed into two orthogonal directions of harmonic motion. The algorithm is designed by using Lissajous-Figure. The control cycle is generated by the timer of the single-chip, and the sampling, calculation, output and execution are completed within a control cycle. The results show that the system can achieve the preset target motion stably, accurately and rapidly, and has strong anti-interference ability and fast response.

Key words: simple harmonic movement; PID algorithm; servo system; IAP15W4K58S4

收稿日期:2017-11-15

1 引言

从古至今,人们对风力的应用从来没有停止过,风力应用在科学研究上也有着重要意义,如飞机、四轴飞行器、风洞等便是人们对风力的典型应用。风力摆作为一种研究风力控制的典型模型,具有造型简单、造价低廉等优点,对其研究可以增加人们对可控风力的了解和对风力控制中一些典型算法的验证,同时为理论教学和课外实践搭建了良好的操作平台[1]。

2 系统总体设计

风力摆控制系统本质为一套伺服随动控制系统,以四个对称布置的风机作为动力源,提供风力摆在四个方向的推力。角度传感器实时采集风力摆的姿态。M C U 主控单元获取角度并与目标值比较[2],经运算后得出控制量,送给风机执行,从而完成预设的定角度直线摆动和圆周运动。为调试方便,系统加入完善的人机交互模块。系统框图如图1所示。

| Techniques of Automation & Applications

23 硬件设计及器件选型

3.1 机械结构设计

风力摆控制系统的机械结构如图2所示。装置采用悬臂梁结构。摆臂选用碳纤维杆材质,质轻而又强度高,通过万向节支吊于横梁上[3]。四个风机对称安装,固定在摆臂上。其中M1、M3构成Y 轴动力源,M2、M4构成X 轴动力源。底座与支撑臂用于稳定重心,加强结构稳固性。

图1 系统整体框图

图2 系统机械结构简图

3.2 电路设计

3.2.1 主控单片机的选型

系统选取STC 公司出品的增强型51单片机IAP15 W4K58S4作为主控芯片[4],可受益于STC 公司提供的STC-ISP 上位机辅助软件,大大提高开发效率。图3为IAP15W4K58S4在本系统中的外设应用情况:利用其自带的6路PWM 发生器中的4路作为四个电机的PWM 控制;串口2负责与MPU6050通信,实时采集角度信息;串口3负责与UART-GPU 串口屏通信,刷新关键参数的显示;串口1负责与PC 上位机通信,来在线调整PID 参数。PID 参数整定完成后,即可关闭比功能,以减少对系统的干扰。

3.2.2 姿态传感器的选型

姿态传感器选取MPU6050[5]。MPU6050是Inven S e n s e 公司推出的一款6轴传感器模块,包括三轴加速度,三轴角速度。其体积小巧,用途广泛。鉴于I A P15 W4K58S4是8位单片机,运算能力有限,而常用的四

元数融合、卡尔曼滤波等姿态解算方法运算量很大,会占用不小的系统时间,导致PID 控制算法及其它程序的执行困难。因此,本系统选用自身带数据融合的姿态传感器模块,通过串口与主控单片机通信,输出角度参数,应用方便,有效减轻了主控单片机的负担。

图3 单片机的外设使用情况

3.2.3 风机的选型

风机选取720空心杯电机配75m m 桨。空心杯电机

具有高转速(30000-50000r /m i n )、高推重比(7-12)、较高的频率响应(4-8H z )、高机动性等优点[6],可为风力摆控制系统提供快速的响应和灵活的机动性,且无需专门的电子调速器,驱动方便。采用小功率M O S F E T 作为电机驱动电路的开关器件,配合P W M [7]技术,使电机调速灵敏精确,且具有很好的线性度。

4 算法设计及软件编程

4.1 物理模型的建立

风力摆的运动是一种单摆运动[8],可以将其理想化为由摆锤和摆线组成。在其摆动角度比较小的情况下,其运动规律可以看作是简谐运动。

由在互相垂直的方向上的两个频率成简单整数比的简谐振动所合成的规则的、稳定的闭合曲线叫莉萨如图[9],如图4所示。风力摆的四个空心杯电机控制风力摆在互相垂直的两个方向做简谐运动,根据莉萨如图理论可以方便地控制风力摆的运动曲线,使其画出圆形、直线和椭圆等各种图形。当两简谐运动的相位差为±90°其他参数相等时轨迹为圆形,当相位差为0°其他参数相等时轨迹为直线。当相位差在0°到90°的范围内时,轨迹为椭圆。

△ψ=0 △ψ=π/2

△

ψ=π

△

ψ=3π/2 △ψ=2π

图4 不同相位差时的莉萨如图形

4.2 正弦函数的生成