智能车制作

标题: 角度控制波形采用的官方方案，求大神解释 [打印本页]

作者: 京口小汉王 时间: 2013-5-19 17:06
标题: 角度控制波形采用的官方方案，求大神解释
[attach]45927[/attach]
Rgyo=0.02,GRAVITY_ADJUST_TIME_CONSTANT 为3s，
红为加速度计，黄为陀螺仪，蓝为融合后。
程序为：
float fDeltaValue;
g_fGravityAngle = (VOLTAGE_GRAVITY - GRAVITY_OFFSET) * GRAVITY_ANGLE_RATIO;
g_fGyroscopeAngleSpeed = -(AngleYspeed() - GYROSCOPE_Y_OFFSET)*GYROSCOPE_ANGLE_RATIO;
g_fCarAngle = g_fGyroscopeAngleIntegral;
fDeltaValue = (int16)((g_fGravityAngle - g_fCarAngle) / GRAVITY_ADJUST_TIME_CONSTANT);
g_fGyroscopeAngleIntegral += (g_fGyroscopeAngleSpeed + fDeltaValue) / GYROSCOPE_ANGLE_SIGMA_FREQUENCY;
陀螺仪跟踪总有延时，也有少许过冲，我的理解是：①，延时通过减小加速度计补偿时间常数TZ，但是只有减小到很小（0.2s官方为3s）才行，这无疑增大了加速度计的补偿量；②，过冲通过减小陀螺仪的比例系数Rgyo，(0.8官方为0.32)
这样改了之后融合波行能很好跟踪加速度计的变化，这无疑减小了陀螺仪的影响。问题是融合波很接近加速度计的，并没有完全滤掉加速度计的噪声，有很多毛刺，也就无法直立，
[attach]45930[/attach]

作者: 河边有棵树 时间: 2013-5-19 22:24
我想问你这VisualScope怎么显示的负数，能不能发下你的下位机通信协议的程序！！！

作者: 等下一个天亮 时间: 2013-5-20 16:51
我也遇到了

作者: xin99 时间: 2013-5-31 13:22
陀螺仪反冲是不很大

作者: 逝去的风 时间: 2013-6-1 00:11
楼主，我的也是按照官方的方案。跟你差不多，你现在车子已经能直立了吗？？？？

作者: 京口小汉王 时间: 2013-6-1 20:23
还是不能，不过滤波已经可以了，在调直立PD

作者: ljl1033835624 时间: 2013-6-30 11:30

京口小汉王发表于 2013-6-1 20:23
还是不能，不过滤波已经可以了，在调直立PD

你们的滤波方案用的是清华的吗？还是别的，清华的话能把你们的参数发给我们看看吗？求帮助！！！

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