求陀螺仪防零飘的程序

一岁就很苦

请问有没有大神写出来使用陀螺仪转弯，但是又能防零飘的小程序呢？我的邮箱是7795921@qq.com

xd62215135

参考陀螺小子就好了

blackblue

//函数名称乱写的啊，反正就是字面的意思吧
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;

一岁就很苦

blackblue 发表于 2019-2-19 16:04
//函数名称乱写的啊，反正就是字面的意思吧
long GetGyroBias()
{

我是新手 还不会用C语言控制EV3

一岁就很苦

blackblue 发表于 2019-2-19 16:04
//函数名称乱写的啊，反正就是字面的意思吧
long GetGyroBias()
{

我是新手 还不会用C语言控制EV3