In this paper,the analysis of the two-wheeled self-balancing trolley is carried out,the corresponding dynamic model is established,and the principle and direction for the subsequent system implementation are provided.The control system uses STM32F103C8T6 as the main control chip,uses MPU6050 as the attitude sensor to measure the attitude angle of the car,and performs data fusion through Kalman filtering to obtain the optimal estimation of the attitude angle.Then output the appropriate PWM wave through the PID control algorithm to control the speed of the motor,build a double closed-loop control to maintain the balance of the car,and can use the Bluetooth module to connect to the mobile phone for remote control.The experiment results show that this method can make the trolley have good balance and can effectively control the operation of the trolley.
Key words
PID /
Kalman filter /
two-wheeled self-balancing trolley /
STM32F103C8T6 /
MPU6050
{{custom_sec.title}}
{{custom_sec.title}}
{{custom_sec.content}}
References
[1] 杨凌霄,李晓阳.基于卡尔曼滤波的两轮自平衡车姿态检测方法[J].计算机仿真,2014,31(6):406-409.
[2] 刘春阳,刘幸,杨曼,等.两轮自平衡小车的系统设计与实现[J].测控技术,2018,37(2):70-74.
[3] 王振运.基于RT-Thread和STM32的双轮自平衡机器人的设计与实现[D].太原:中北大学,2016.
[4] 王建平,卢杉,武欢欢.TB6612FNG在直流电机控制设计中的应用[J].电子设计工程,2010,18(6):65-67.
[5] 赵映川.编码器原理与应用分析[J].无线互联科技,2018,15(22):67-69,78.
[6] 邓洪明,贺勇,於小杰,等.卡尔曼滤波在无人机姿态中的应用研究[J].自动化技术与应用,2019,38(11):1-4.
[7] 沈跃杰,行鸿彦,王水璋.基于粒子群优化的串级模糊PID无人机飞行控制系统[J].电子测量技术,2022,45(1):96-103.