Minor changes, main tests.
Vectorized DMU, MAG in progress. Arithmetic added.
magnetometer initial functions.
main unchanged