用四元数法进行姿态解算的matlab程序。