从数据看,姿态能不能稳住,九成靠的是滤波这层功夫,而不是滤波器的名字多好听。MPU6050里那颗加速度计,静下来测重力很准,一跑起来就被振动噪音拉偏;陀螺仪恰恰相反,动起来积分很稳,时间一长又漂得厉害。互补滤波和卡尔曼,本质都是在这两个传感器之间做取长补短。区别在于,互补滤波靠一个经验系数把高频噪声滤掉、把漂移拉回来,计算量小到单片机随便跑;卡尔曼则是用一套状态方程,估计出陀螺仪零漂和当前姿态的最优值,更抗干扰,但要你懂矩阵、调过程噪声协方差,稍不留神就比裸奔还抖。我的建议很直接:平衡车、机械臂这些实时闭环的场景,先把互补滤波跑通,它在你手上出效果的几率最大;等你遇到强振动、大角度翻身,再去补卡尔曼这条更精细的路,两头都摸过,才算真正把姿态这关吃透。