support goal as high-level command

[thias15]

Right now the driving policy accepts high-level commands such as:

• turn left
• go straight
• turn right

We would like to add an option to specific a goal instead relative to the robot pose.