Add orientation support

Add support for specifying the desired orientation in radians. If orientation = 0, the drone first rotates to face the goal and goes straight, else, the drone first rotates to the desired orientation (0 being facing north) and then moves to the goal maintaining the orientation.

We may need to modify the rotation in order to complain with REP103.