最近做毕业设计，要做两轮平衡车，，以前没接触过，学校也没人做过，有很多问题解决不了，有哪位大神能帮忙解决一下问题？
我用msp430f149单片机做，用AD读取后用下面的公式来进行角度和角速度的转换：
angle_Ry=asin((angle_AdcRx*3.3/4095-2.46)/0.8)*180/3.14;
Gyro_RateAR2=(gyro_AdcAR2*3.3/4095-0.95)/(0.00067*5.1);
转换完成后，用网上通用的卡尔曼滤波程序，将angle_Ry和Gyro_RateAR2传进去进行滤波，得到角速度Zhili_gyro和角度Zhili_angle，然后用这两个值得到PWM的值，用增量式PID，进行控制电机，这样对吗？
但是当我用串口输出验证测量的角度时加速度计与实际的角度接近，但陀螺仪就得不到了，假如小车倾斜15°，陀螺仪的输出值和0°时相同，请问陀螺仪的输出电压在没有旋转的时候其输出电压是相同的吗？
我没有示波器，上位机编程还不太懂，无法通过串口来调节陀螺仪和加速度计的参数，有哪位大神能帮一下帮吗？给个指导思路，我的QQ：1533724585 |
|
楼主
