自平衡小车
刘骢/Self-Balance-Car
刘骢/Self-Balance-Car
对陀螺仪和加速度计使用互补滤波计算出Pitch轴和Roll轴,再对磁力计得到的三轴数据根据Pitch和Yaw利用旋转矩阵修正,得到Yaw轴数据,最后结果进行中位值平均滤波,通过串口输出到上位机。Download
图为一阶互补滤波filter.c#include "filter.h" #include <string.h> int8_t MedianAverageFilter_Init(MedianAverageFilter_t...
filter.c#include "filter.h" #include <string.h> int8_t MedianAverageFilter_Init(MedianAverageFilter_t* filter...
hmc5883l.c#include "hmc5883l.h" #include <math.h> #include <stdint.h> #include "delay.h" #inc...