Realization of Unmanned Self-driving Bicycle Based on Angular Momentum Wheel Control
MENG Jian-xin,ZHANG Hai-ruo,LI Hao,LI Dan-dan
DOI: https://doi.org/10.3969/j.issn.1674-9146.2023.02.100
2023-01-01
Abstract:Aiming at the self-balancing problem of unmanned bicycle, an angular momentum wheel designed by the law of conservation of angular momentum was proposed to keep the static balance of unmanned bicycle for a long time. The final control scheme of angular momentum wheel is determined by dynamic analysis of bicycle tilt. In terms of driving system,this paper adopts the 32 b STM32F407ZGT6 chip with M4 kernel, and uses Odrive to directly control the angular momentum wheel speed. Using the CH100 attitude sensor integrated with three-axis accelerometer, three-axis gyroscope and a microcontroller to obtain bicycle attitude information. A first-order low-pass filter is used to reduce the influence of motor jitter on the measured values of CH100 gyroscope. The high-frequency jitter filter is removed by the second order Butterworth filter and Kalman filter. Final debugged static balance parameters KP, KI, KD, maximum output and maximum integral of the angular momentum wheel are-120,-1.0,-3 000, 28 and 10 respectively; linear travel parameters KP, KI, KD,maximum output and maximum integral are-100, 0,-500, 28 and 10 respectively; steering gear control parameters KP, KI,KD, maximum output and maximum integral are 90, 0, 0, 80 and 0 respectively. In Odrive parameters, Vel＿ramp＿rate of the angular momentum wheel is 40, and that of the motor is 8. The VEL＿gain of the angular momentum wheel is 0.035 and that of the motor is 0.15.