[math] improve math lib

add vect_zero function
try to prevent aliazing issues in runge-kutta4
[math] avoid aliazing issue on rk1 as well...
[nps] get mag field from INS section if not in AHRS