极客工坊

 找回密码
 注册

QQ登录

只需一步,快速开始

查看: 14098|回复: 1

小白求教,关于滤波算法的问题

[复制链接]
发表于 2016-12-11 08:52:41 | 显示全部楼层 |阅读模式
这个是关于加速度的代码,图形显示是没有问题了 ,不过现在要求给代码加入滤波。网上也找到很多十大算法啥的,可惜我是小白,所以找到了也不知道怎么用,有没有大神能够指点下,感激不尽!!
#include <Wire.h>
#include <SFE_MMA8452Q.h>

MMA8452Q accel;
void setup()
{
  Serial.begin(9600);
  Serial.println("MMA8452Q Test Code!");

accel.init();
}

void loop()
{
  
  if (accel.available())
  {
    accel.read();
   
    printCalculatedAccels();

    printOrientation();
   
    Serial.println();
  }
}

void printAccels()
{
  Serial.print(accel.x, 3);
  Serial.print("\t");
  Serial.print(accel.y, 3);
  Serial.print("\t");
  Serial.print(accel.z, 3);
  Serial.print("\t");
  
}

void printCalculatedAccels()
{
  Serial.print(accel.cx, 3);
  Serial.print(",");
  Serial.print(accel.cy, 3);
  Serial.print(",");
  Serial.print(accel.cz, 3);
  Serial.print(",");
}

void printOrientation()
{

  byte pl = accel.readPL();
  switch (pl)
  {
  case PORTRAIT_U:
    Serial.print("Portrait Up");
    break;
  case PORTRAIT_D:
    Serial.print("Portrait Down");
    break;
  case LANDSCAPE_R:
    Serial.print("Landscape Right");
    break;
  case LANDSCAPE_L:
    Serial.print("Landscape Left");
    break;
  case LOCKOUT:
    Serial.print("Flat");
    break;
  }
}
回复

使用道具 举报

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

本版积分规则 需要先绑定手机号

Archiver|联系我们|极客工坊

GMT+8, 2024-4-26 13:33 , Processed in 0.037368 second(s), 18 queries .

Powered by Discuz! X3.4 Licensed

Copyright © 2001-2021, Tencent Cloud.

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