建基於球形線性內插法之最佳三元組演算法及其應用

Abstract

本文所探討的演算法，是姿態判定時所使用的方法之ㄧ。姿態判定可以描述載具在空間中運動之軌跡、位置及指向。人造衛星、太空梭、手寫儀器等之運動皆與姿態判定有關。然而，姿態判定的準確性影響載具的安全和效率，這時候演算法的演繹就顯得格外重要。 隨著新興產品的需要，近年來包括互動式電子筆、手術用之手持儀器等應用，都有相關的研究。大部分所使用的姿態判定演算法不外乎三元組演算法、最佳三元組演算法、四元數估測法、遞迴式四元數估測法、最佳遞迴式四元數估測法等，有些方法配合卡爾曼濾波器的使用，可以降低雜訊帶來的誤差。 然而，有些演算法的細節可以改進，使演算過程更加健全。本文便是根據最佳三元組演算法的想法，引入球形線性內插法及蒙地卡羅模擬法幫助運算，我們稱此演算法為「建基於球形線性內插法之最佳三元組演算法」。 在本演算法提出後，透過電腦模擬，驗證結果是合乎預期的。最後設計兩個實驗，以期將演算法的功能付諸實際應用。 本文將詳細介紹相關背景知識、演算法推導過程、模擬驗證方法、實驗結果分析等，在附錄中並有相關公式推導。

This article discusses an algorithm which is used for attitude determination. Attitude determination describes the trajectory, position, and orientation of vehicles in space. The movements of satellites, space shuttles, or writing instruments have strong relations to attitude determination. However, the accuracy of attitude determination affects the safety or efficiency of vehicles. Thus, the deduction of the algorithm is especially important. With the need for new products recent years, there are a lot of applications and related works, including interactive electronic pen and hand-held instruments used in surgery. TRIAD algorithm, optimized TRIAD algorithm, QUEST, REQUEST, and optimal REQUEST are all in common use for attitude determination. Moreover, with the use of Kalman filter, some of these methods can reduce the error caused by noise. However, some of the algorithm details can be improved to make the process more robust. This article is based on the idea of the optimized TRIAD algorithm. In addition, SLERP and Monte Carlo simulation are introduced for calculation. We name this algorithm as “SLERP-Based Optimal TRIAD Algorithm.” After this algorithm is proposed, the verifications are in line with our expectations through computer simulation. Finally, two experiments are designed to realize the algorithm in reality. This article will detail the relevant background knowledge, algorithm derivation, simulation verification, and experimental results analysis. Besides, there are related formulas in the appendixes.