角速度进行姿态解算