Control actions should be relative to the heading angle

[hallfjonas]

• current controls are a mix of up, down, left, right in the global frame
• the dynamics would be nicer if they were more directly related to steering and accelerating
• use heading angle to do this