Merging in a lot of changes used to make Bob work at G4S

This includes the new SMACH-based task executor and fixes for navigation preemption.