ZHANG Guo-jun, LI Shao-ming, YAN Xiao-heng, et al. Design of motion control system for wind pendulum[J]. 2016, 35(12): 106-109. DOI: 10.13873/J.1000-9787(2016)12-0106-04.
风力摆运动控制系统设计
摘要
系统以32位的MK60DN256ZVLL10单片机为核心
通过运动处理传感器MPU6050测量风力摆在三维空间的位置
控制安装在摆杆底端的4个轴流风机使得风力摆运动。在风力摆正下端置一激光笔
根据MPU6050的反馈数值及三角函数运算
运用两个独立PID算法
控制风力摆做直线或圆周运动
且在圆周运动时使风力摆受到50
6
0 W台扇在水平方向吹风的干扰后
可以5 s内恢复运动轨迹。实验数据表明:风力摆能够在15 s内
完成设定的直线运动
轨迹误差小于±0.5 cm;能够在20 s完成设定半径的圆周运动
轨迹能够在设定半径±2.5 cm的圆环内。
Abstract
The system controls four axial flow fan which mounted in the bottom of the pendulum in order to make the wind pendulum move 32 bit MK60DN256ZVLL10 microcontroller is used as core; position of wind pendulum placed in three-dimensional space is measured through motion processing sensor MPU6050. There is a laser pointer under the wind pendulum. The wind pendulum can do linear or circular motion according to the feedback value and trigonometric functions computation with two independent PID algorithm. The PID algorithm can make the wind pendulum when it is disturbed by 50
60 W FANS recovery circular motion within 5 s. Experimental results show that the wind pendulum completes predetermined linear motion with trajectory errors less than± 0. 5 cm with
in 15 s and circular motion within diameter ± 2. 5 cm