L3G400d单独使用实验

news/2025/3/15 22:17:56/

这个实验无实际应用价值,因为累积误差,哪怕一丁点,过一段时间就误差超级大了,一般在x,y方向的旋转是融合adxl345的数据

#include <Wire.h>
#include <L3G4200D.h>
#include "FilteringScheme.h"
L3G4200D gyro;
KalmanFilter kFilters[3]; //only one value to filter
KalmanFilter kFilterAfter;
MedianMeanFilter meanFilters[3];
unsigned long mTick = 0;
int  mBaseCnt = 100;
float mBaseX = 0.0f;
float mBaseY = 0.0f;
float mBaseZ = 0.0f;float mAngleX = 0;
float mAngleY = 0;
float mAngleZ = 0;
void setup() {Serial.begin(9600);Wire.begin();gyro.enableDefault();mTick = millis();//float qVal = 0.015; //Set Q Kalman Filterfloat rVal = 1.2; //Set K Kalman Filterfloat p = 5.0;float InitVal = 65;kFilters[0].KalmanInit(qVal,rVal,p,InitVal); //Initialize Kalman FilterkFilters[1].KalmanInit(qVal,rVal,p,InitVal);kFilters[2].KalmanInit(qVal,rVal,p,InitVal);kFilterAfter.KalmanInit(qVal,rVal,p,InitVal);//initialBase();
}void loop() {gyro.read();gyro.g.x = kFilters[0].measureRSSI(gyro.g.x);gyro.g.y = kFilters[1].measureRSSI(gyro.g.y);gyro.g.z = kFilters[2].measureRSSI(gyro.g.z);//gyro.g.x = meanFilters[0].Mean(gyro.g.x);if( mBaseCnt > 0){mBaseCnt --;mBaseX += gyro.g.x;mBaseY += gyro.g.y;mBaseZ += gyro.g.z;mBaseX /= 2;mBaseY /= 2;mBaseZ /= 2;}else{gyro.g.x -= mBaseX;gyro.g.y -= mBaseY;gyro.g.z -= mBaseZ;//gyro.g.x = kFilterAfter.measureRSSI(gyro.g.x);float nowTick = millis();float dt = nowTick - mTick;mTick = nowTick;mAngleX = mAngleX + gyro.g.x * dt / 1000.0f * 0.00875;//0.07f;Serial.print("Angle:");Serial.println(mAngleX);}Serial.print("G ");Serial.print("X: ");Serial.print((int)gyro.g.x);Serial.print(" Y: ");Serial.print((int)gyro.g.y);Serial.print(" Z: ");Serial.println((int)gyro.g.z);delay(100);
}


http://www.ppmy.cn/news/112912.html

相关文章

联想g400怎么进入BIOS设置|联想g400打开BIOS界面方法

很多时候我们需要进入BIOS进行相关的设置&#xff0c;比如设置启动项、BIOS密码等等&#xff0c;联想电脑只要在开机启动时不断按F2或FnF2就可以进入BIOS&#xff0c;不过有用户反映联想g400不管按什么键都不能进入BIOS界面&#xff0c;那么联想g400要怎么进入BIOS设置呢&#…

配置lenovo G400 + Ubuntu 13.04无线网卡BCM43142

已有 9161 次阅读 2013-8-2 10:49 |个人分类:Linux|系统分类:科研笔记|关键词:无线网卡 lenovo 本人笔记本的型号为lenovo E430&#xff0c;买的时候机子预装了win8&#xff0c;折腾很久才把ubuntu安装上。装好之后发现不能无线上网&#xff0c;经过检查发现没有安装无线网卡驱…

记一次从日立G400划一个LUN给dg数据库

从日立G400划一个1T的lun&#xff0c;映像路径给DG主机 cat /proc/scsi/scsi 为不重启主机识别设备 echo "- - -" > /sys/class/scsi_host/host1/scan echo "- - -" > /sys/class/scsi_host/host10/scan echo "- - -" > /sys/clas…

使用老毛桃U盘给联想G400装系统

1.插入制作好的老毛桃U盘&#xff0c;关机状态下按电源键旁边的“一键恢复”键&#xff08;转弯的箭头&#xff09;。 2.选择“BIOS Setup”&#xff0c;进入BIOS模式。 3.将光标移至BOOT选项。 4.将USB HDD选项置顶&#xff0c;并按FnF10. 5.选择YES&#xff0c;并按enter键&…

联想G400安装win7+centos双系统并安装BCM431432无线网卡驱动

1、安装centos 首先用win7自带的分区工具划分出一个80G的空闲分区用来安装centos&#xff0c;鼠标放在我的电脑点击右键&#xff0c;单击管理&#xff0c;选择磁盘管理&#xff0c;我们可以看到&#xff0c;整个硬盘被分为若干个分区&#xff0c;我们找到一个分区&#xff0c;…

联想g400从u盘启动计算机,联想g400s怎么重装系统 联想g400s重装系统方法【图文步骤】...

大家应该都知道,在电脑使用了一段时间后,由于积累的垃圾过多,使得电脑的内存减小,运行速度也会变慢很多;而不小心下载了一些带病毒的软件,或者被u盘感染,都有可能使得电脑的运行速率减缓。有些时候对电脑垃圾进行清理,或者排杀了病毒之后,电脑依旧不能正常运行。这时候…

联想g400从u盘启动计算机,联想g400怎么进bios设置u盘启动图文教程

虽然成功学会u盘装系统的人很多&#xff0c;但是设置u盘启动在小白们的眼中却没有那么容易&#xff0c;特别是在按快捷键时却调不出u盘启动菜单。其实这是需要修改bios设置&#xff0c;那么&#xff0c;联想g400怎么进bios设置u盘启动?今天快启动小编为大家分享详细的操作教程…

联想g400从u盘启动计算机,联想g400怎么从u盘启动-联想g400设置u盘启动方法

使用U盘装系统已经很普遍了&#xff0c;只要将电脑设置从U盘启动&#xff0c;就可以用U盘装系统&#xff0c;非常简单&#xff0c;联想电脑一般是开机按F12就能调出启动菜单&#xff0c;然后选择USBHDD回车就可以U盘启动&#xff0c;不过有用户反映联想g400调不出U盘启动菜单&a…