文章:https://www.cnblogs.com/we1238/articles/7562028.html
輸入量
通過mup6050姿态傳感器,我們可以分别得到X、Y、Z軸三個方向的加速度和角速度分量。
![](https://img.laitimes.com/img/_0nNw4CM6IyYiwiM6ICdiwiIwczX0xiRGZkRGZ0Xy9GbvNGL2EzXlpXazxSP9cXTw0keORzZq1EM4wmYwhGWhxGZzwEMW1mY1RzRapnTtxkb5ckYplTeMZTTINGMShUYfRHelRHLwEzX39GZhh2css2RkBnVHFmb1clWvB3MaVnRtp1XlBXe0xyayFWbyVGdhd3LcV2Zh1Wa9M3clN2byBXLzN3btg3Pn5GcuMzMzUzNwkDM1AjMwEjMwIzLc52YucWbp5GZzNmLn9Gbi1yZtl2Lc9CX6MHc0RHaiojIsJye.png)
輸出量
我們需要準确得被測物的姿态角,即歐拉角,且計算的姿态角盡可能與實際姿态角度一緻。
歐拉角是用來确定定點轉動剛體位置的3個一組獨立角參量,由章動角θ、旋進角(即進動角)ψ和自轉角φ組成。我們一般使用pitch(俯仰) yaw(偏航) roll(滾動)表示三個滾動角。如下圖所示: