【摘要】 通过对倒立摆模型的受力分析,使两轮小车保持自平衡运行状态。硬件上采用STM32F103ZET6单片机为核心控制器,利用MPU6050检测小车的速度和加速度,选择L298N驱动两个两相直流电机,采用霍尔测速码盘获得电机的转速,通过电磁检测电路实现电磁轨迹跟踪。软件上采用PI和PD构成串级控制算法,MPU6050采集到的小车姿态数据经卡尔曼滤波进行数据处理。最终实现了平衡车的稳定控制,完成了小车直立和行走功能。更多还原

【Abstract】 Through the stress analysis of the inverted pendulum model,the two-wheeled trolley is kept in self-balance running state. As for software,STM32F103ZET6MCU is adopted as the core controller,MPU6050 is used to detect the speed and acceleration of the trolley,L298N is selected to drive two two-phase DC motors,Hall velocity measurement dial is used to obtain the speed of the motor,electromagnetic detection cicuit is used to realize electromagnetic track tracking. As for hardware,PI and PD are used to construct cascade control algorithm,Kalman filter is used to process is used the trolley attitude data collected by MPU6050. Finally,the stability control of the balanced trolley is realized,and the upright and walking functions of the trolley are completed.更多还原