一个关于姿态的卡尔曼滤波器用着非常不错大家都来用用(A linear Kalman filter estimating altitude and vertical velocity by doing sensor fusion of acceleration and any altitude measurement such as e.g. barometer or SONAR.)