Balancing robot for dummies

kas,thanks for your suggestion.it is the parmeter! After modifying them, the effect of kalmanfilter is much better.

http://niebing1987.tuzhan.com/photo/09ea592eba247adc.html

;D ;D ;D ;D ;D