求各位学霸兄指导指导,come on,具体点哟!静止的立起来的
代码三个地方被改成这样,虽然基本上快要静止了,但是有些抖动是怎么回事
Bias=Angle-3;
balance=70*Bias+Gyro*0.125;//===计算平衡控制的电机PWM PD控制
Velocity=Encoder*5.5+Encoder_Integral/110; //===速度PI控制器