Added Waypoints map & execution mechanism

Added orientation management
Added skeleton for executing 'real' commands on robot
(to connect to MD25)
Marking a goal as done unblocks all others

Otherwise, we would never return to fresco, for instance, since it would
always be considered 'blocked' even if adversary has moved