四元数+互补滤波
四元数
圆点博士小四轴之四元数算法。四元数算法在小四轴上一般直接采用Madgwick的算法就差不多。
这是一个居于GPL的协议,大家可以自由使用。
//================
// IMU.c
// S.O.H. Madgwick
// 25th September 2010
//=================
转载如下:
void IMUupdate(float gx, float gy, float gz, float ax, float ay, float az) {
}
在小四轴上,我们常见的滤波方法是互补滤波。下面我们来看互补滤波是怎么工作的。
根据下图,我们可以知道,
我们每次得到的角度数据是由下列成分组成的:
1。当前的角度
2。当前陀螺仪运动所产生的角度
3。当前物体运动所产生的加速度角度
通过改变系数a和b, 我们能够调整上述各个成分的权重值,从而得到不同的滤波结果。通常我们采用a>b来进行运算。即当前的角度和陀螺仪运动产生的角度占有更大的比重,而当前加速度角度占有比较小的比重。
bs004_mpu6050_acc_pitch_com=
(bs004_filter_high*(bs004_mpu6050_acc_pitch_com+bs004_mpu6050_gyro_pitch_raw*bs004_filter_time)
+bs004_filter_low*bs004_mpu6050_acc_pitch_raw)
/(bs004_filter_high+bs004_filter_low);
bs004_mpu6050_acc_roll_com=
(bs004_filter_high*(bs004_mpu6050_acc_roll_com +bs004_mpu6050_gyro_roll_raw *bs004_filter_time)
+bs004_filter_low*bs004_mpu6050_acc_roll_raw)
/(bs004_filter_high+bs004_filter_low);
相关文章
- 卡尔曼滤波,互补滤波,“Tsinghua”滤波
- 【MATLAB教程案例32】基于matlab的交通标志检测分割算法的仿真——形态学处理,膨胀,腐蚀,形状检测,颜色模型,小波滤波等知识的综合应用
- 医学成像技术滤波反投影
- 语音信号的滤波处理matlab源码
- 空间滤波 - 锐化处理 - 一阶差分算法(Sobel、Scharr算子)
- 用相关响应法(滤波法)进行孤立点检测的原理和MATLAB代码
- 3、halcon图像预处理:基本变换、滤波和人脸祛斑
- 使用kinect2获取点云数据,滤波保存转为octomap
- 图像与滤波 (转载)
- GNSS说第(七)讲---自适应动态导航定位(八)---抗差自适应滤波
- 【图像处理】——Python OpenCV实现形态学膨胀、腐蚀开闭操作(可以用于图像滤波、图像分割等)
- 【图像处理】——图像滤波(Python+opencv实现三种方法:均值滤波、中值滤波、高斯滤波等)