Smoothly transition from current pose to desired pose

[gerth2]

Update the path planner to only command a fixed maximum rotation at every step - the maximum delta in rotation should be constrained by a maximum rotational velocity that's configured in the class (like there's also a maximum speed).

[gerth2]

Added