姿态融合的一阶互补滤波、二阶互补滤波、卡尔曼滤波核心程序

//一阶互补// a=tau / （tau + loop time）// newAngle = angle measured with atan2 using the accelerometer//加