1,212
edits
Changes
no edit summary
TRIAD method is useful when we have only two vector measurements. If we need better accuracy and have more than two vector measurements, we need to use a more general algorithm. Before developing an algorithm, we need to make our problem statement more precise.
the N vectors. <ref>http://www.dept.aoe.vt.edu/~cdhall/courses/aoe4140/attde.pdf</ref><br \>
[[File:Equation24.png|frame|center]]
In this expression, J is the loss function that has to be minimized, k is the counter for theN observations, w_k is weight assigned to the kth measurement, v_{kb} is the matrix consisting of the measuredcomponents in the body frame, and vki v_{ki} is the matrix consisting of components in the inertialframe as determined by using appropriate mathematical models. This loss function is asum of the squared errors for each vector measurement. If the measurements and0andmathematical models are all perfect, then J = 0, since the first equation on this page will be satisfied for all N vectorsand J = 0. If there are any errors or noisy measurements, then J > 0. The smallerwe can make J, the better the approximation of R_{bi}.
== Q-Method ==
In this section we present one method of the several methods to solve this minimization problem known as the Q-method.
We first expand the loss function as
[[File:Equation26Equation73.png|frame|center]]Assuming that the normalized vectors are normalized , we see that,[[File:Equation27Equation74.png|frame|center]]
Defining,
[[File:Equation28Equation75.png|frame|center]]We can see that minimizing in order to minimize J is equivalent , we need to maximizing maximize g(R). This problem can be written in a better and more elegant way by representing rotation matrix R in terms of the quaternion
[[File:Equation29.png|frame|center]]
R can be written in terms of q as
Wherein,
[[File:Equation34.png|frame|center]]
Now we want to maximise g. However, but noting that quaternion elements are not independent, but the constraint [[File:Equation35.png]] must also be satisfied. So we use the lagrangian multiplier method and differentiate with respect to [[File:Equation36.png]] we get [[File:Equation37.png]] So now, we have reduced the problem has been reduced to an eigenvalue problem for the matrix K.
Since, K is a 4x4 matrix, it can have at most 4 different eigenvalues. Substituting [[File:Equation37.png]] in [[File:Equation38.png]], we get
[[File:Equation39.png|frame|center]]