本设计是2015年TI杯大学生电子设计竞赛国赛题目,本设计方案采用4个空心杯电机作为风力驱动,采用si2302mos驱动空心杯电机,采用mpu6050陀螺仪采集风力摆的姿态角度和角速度来反馈风力摆的系统状态,采用pid算法控制摆的周期状态,本方案可以实现:
(1)来回摆动画一条可设定长度的直线,其宽度偏移小于1cm,长度偏移小于1.5cm;
(2)摆动画半径可设定的圆形,其圆偏差小于1cm;
(3)可实现将摆拉起一个角度后2s内完全静止于中心;
(4)可实现摆动周期性画长宽可设定的矩形;
(5)可实现摆动周期画三边可设定的三角形;
本代码仅提供参考,请勿上传到其他网站赚取积分,感谢。
1