姿态解算手稿整理

手稿整理

从一开始的姿态表示（欧拉角、四元数、旋转矩阵），到滤波用的拉普拉斯变换，再到控制PID。