重力加速度归一化后的向量是 [0,0,1]T ,转换到机体坐标系后为 q−1×g×q=[2(q1q3−q0q2) , 2(q0q1+q2q3) , 2(12−q21−q22)]T 机体坐标系下测得的重力向量可以表示为 [ax,ay,