飞行器控制笔记(三)——姿态解算之方向余弦更新姿态
0向量叉乘的性质
对于向量 m=[b1b2b3] m = [ b 1 b 2 b 3 ] , 和向量 n⃗ =[k1k2k3] n → = [ k 1 k 2 k 3 ] ,它们之间的叉乘 m×n=[m]×⋅n m × n = [ m ] × ⋅ n ,其中,
[m]×=⎡⎣⎢0b3−b2−b30b1b2−b10⎤⎦⎥ [ m ] × = [ 0 − b 3 b 2 b 3 0 − b 1 − b 2 b 1 0 ]
一 旋转矩阵
我上一篇博客记录了当前的机体坐标可以通过对大地坐标进行三次绕轴的基本旋转得到,用坐标变换矩阵的形式可以表示为 Rbe=Rx(ϕ)Ry(θ)Rz(ψ) R e b = R x ( ϕ ) R y ( θ ) R z ( ψ ) ,这表示了从大地坐标到机体坐标的变化,而姿态解决是通过机体坐标的变化来计算机体坐标相对于大地坐标的状态,因此需要求得 Reb R b e ,也就是对应地从机体坐标系按 先旋转−ϕ再旋转