找回密码
 马上注册

QQ登录

只需一步,快速开始

查看: 4615|回复: 4

求陀螺仪防零飘的程序

[复制链接]
发表于 2019-2-19 14:32:07 | 显示全部楼层 |阅读模式
悬赏20乐币未解决
请问有没有大神写出来使用陀螺仪转弯,但是又能防零飘的小程序呢?我的邮箱是7795921@qq.com

如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
发表于 2019-2-19 14:42:11 | 显示全部楼层
参考陀螺小子就好了
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复

使用道具 举报

发表于 2019-2-19 16:04:10 | 显示全部楼层
//函数名称乱写的啊,反正就是字面的意思吧
long GetGyroBias()
{
   
   SetSensorGyro(Gyro_port) ;
   timer_count = CurrentTick();  // set timer_count
   GyroBiasCount = 0;
   while (CurrentTick() < (5000+timer_count))
      {
         // filter the sensor output
             Gyro_value = GyroSensorRawRead(port);
             Wait(100);
             GyroBiasCount += 1;
             GyroBias += Gyro_value;
       }
     GyroBias = GyroBias / GyroBiasCount; //Sum of values devide by time measured.
     return GyroBias;
}

  //使用时,如果你跑一个周期用时是"d_time",继续进行滤波

  Gyro_Raw = GetGyroBias();
  GyroBias = d_time *Gyro_Raw +(1-d_time)*GyroBias ;
  Gyro_Raw = Gyro_Raw - GyroBias;
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复

使用道具 举报

 楼主| 发表于 2019-2-19 18:16:14 | 显示全部楼层
blackblue 发表于 2019-2-19 16:04
//函数名称乱写的啊,反正就是字面的意思吧
long GetGyroBias()
{

我是新手 还不会用C语言控制EV3
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复

使用道具 举报

 楼主| 发表于 2019-2-19 18:20:13 | 显示全部楼层
blackblue 发表于 2019-2-19 16:04
//函数名称乱写的啊,反正就是字面的意思吧
long GetGyroBias()
{

我是新手 还不会用C语言控制EV3
如果您觉得我的帖子对您有用,请不吝给我一个“赞”!
回复

使用道具 举报

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

本版积分规则

QQ|手机版|中文乐高 ( 桂ICP备13001575号-7 )

GMT+8, 2024-3-29 18:59 , Processed in 0.147502 second(s), 16 queries .

Powered by Discuz! X3.5

Copyright © 2001-2020, Tencent Cloud.

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