Open Huangxianfeng001 opened 1 month ago
HalfMagnetic
returns the direction of the magnetic field scaled by 0.5. This is the direction of the magnetic field according to the AHRS algorithm's current measurement of orientation. The scaling by 0.5 is just to avoid redundant operations.
the calculation of in the equation of HalfMagnetic in your code seems different from the equation of Mahony algorithm. In the function of HalfMagnetic, seems you directly transform the vector [0, 1, 0] from Global Coordinate system to the Body Coordinate system. hope you can explain it.