智能车制作

 找回密码
 注册

扫一扫,访问微社区

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

6050用角速度积分出的结果和加速度算的不在一个数量级上

[复制链接]

1

主题

5

帖子

0

精华

中级会员

Rank: 3Rank: 3

积分
225
威望
128
贡献
57
兑换币
71
注册时间
2016-12-10
在线时间
20 小时
毕业学校
山东建筑大学
跳转到指定楼层
1#
发表于 2017-4-11 21:03:45 | 只看该作者 回帖奖励 |倒序浏览 |阅读模式
void Get_Attitude()
{
  float xishu=16.4;
  Acc_Z = Get_Z_Acc();
  Gyro_Y= Get_Y_Gyro();

  Angle =180*((Acc_Z - Acc_Offset)*1.0)/(Z_MAX - Z_MIN);
  Angle_Speed=-(Gyro_Y-Gyro_Y_Offset) /xishu;
  temp_uart+=Angle_Speed*0.005;
  Kalman_Filter(Angle,Angle_Speed);
}

中断是5ms一次;
最后Angle和temp_uart不在一个数量级上,用的是6050陀螺仪精度选的是2000.

回复

使用道具 举报

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

本版积分规则

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

GMT+8, 2024-12-25 02:33 , Processed in 0.093310 second(s), 30 queries , Gzip On.

Powered by Discuz! X3.2

© 2001-2013 Comsenz Inc.

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