智能车制作

标题: 陀螺仪加速度计图像 [打印本页]

作者: 家YO 时间: 2014-5-2 16:25
标题: 陀螺仪加速度计图像
[attach]59314[/attach]
g_fGravityAngle = (VOLTAGE_GRAVITY - GRAVITY_OFFSET) * GRAVITY_ANGLE_RATIO;

g_fGyroscopeAngleSpeed = (VOLTAGE_GYRO - g_GYROSCOPE_OFFSET ) * GYROSCOPE_ANGLE_RATIO;
// if(g_fGyroscopeAngleSpeed>=-3.500&&g_fGyroscopeAngleSpeed<=3.500)
// g_fGyroscopeAngleSpeed=0.000;
g_fCarAngle = g_fGyroscopeAngleIntegral;

fDeltaValue = (g_fGravityAngle - g_fCarAngle) / GRAVITY_ADJUST_TIME_CONSTANT;

g_fGyroscopeAngleIntegral += (g_fGyroscopeAngleSpeed + fDeltaValue) / GYROSCOPE_ANGLE_SIGMA_FREQUENCY;

红g_fGravityAngle 加速度计
黄g_fGyroscopeAngleSpeed 陀螺仪
蓝g_fGyroscopeAngleIntegral 融合后的角度

请问这个输出图像对吗？？

作者: 雪雨星风 时间: 2014-5-2 16:29
我们的也是这图像，求大神指导

作者: 鱼头豆腐 时间: 2014-5-2 16:36
慢慢来，希望大神指导

作者: 梦涛007 时间: 2014-5-2 16:42
求大神留步解答~

作者: hymwgk 时间: 2014-5-2 19:31
陀螺仪信任度太高了？加速度计都没起什么用了好像

欢迎光临智能车制作 (http://dns.znczz.com/)