整理获取姿态算法