Adds a MotionStatus proto. Wired and hooked up, used in nav, not yet properly set in motion.
Hooks up sonar message to behaviors. Updates nav calls to sonar.