智能车制作

 找回密码
 注册

扫一扫,访问微社区

查看: 2164|回复: 0
打印 上一主题 下一主题

[其他] 清华方案的疑问:GRAVITY_ADJUST_TIME_CONSTANT和GYROSCOPE_ANGLE_SIGMA_FREQUENCY

[复制链接]

1

主题

3

帖子

0

精华

中级会员

Rank: 3Rank: 3

积分
298
威望
148
贡献
94
兑换币
94
注册时间
2015-3-17
在线时间
28 小时
毕业学校
皖西学院
跳转到指定楼层
1#
发表于 2015-4-29 21:50:50 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
清华方案的疑问:角度计算函数中的GRAVITY_ADJUST_TIME_CONSTANT和GYROSCOPE_ANGLE_SIGMA_FREQUENCY是怎么求得??请大神指点
void AngleCalculate(void) {
float fDeltaValue;
g_fGravityAngle = (VOLTAGE_GRAVITY - GRAVITY_OFFSET) *
GRAVITY_ANGLE_RATIO;
// g_fGravityAngle = 0;
g_fGyroscopeAngleSpeed = (VOLTAGE_GYRO - GYROSCOPE_OFFSET) *
GYROSCOPE_ANGLE_RATIO;
g_fCarAngle = g_fGyroscopeAngleIntegral;
fDeltaValue = (g_fGravityAngle - g_fCarAngle) /
GRAVITY_ADJUST_TIME_CONSTANT;
g_fGyroscopeAngleIntegral += (g_fGyroscopeAngleSpeed + fDeltaValue) /
GYROSCOPE_ANGLE_SIGMA_FREQUENCY;
}

回复

使用道具 举报

您需要登录后才可以回帖 登录 | 注册

本版积分规则

关于我们|联系我们|小黑屋|亿加合和智能车制作 ( 黑ICP备2022002344号

GMT+8, 2024-5-6 11:02 , Processed in 0.059417 second(s), 36 queries , Gzip On.

Powered by Discuz! X3.2

© 2001-2013 Comsenz Inc.

快速回复 返回顶部 返回列表