Navigator rewrite and offboard2

This is my work on top of offboard2, merged with the navigator_rewrite.