fix switch over between modes
fixed wrong direction of nav governor
cleanup vector.c
fixed som rotational problems and H-governor switch