Updated DriveForward code to prioritise turns

Set ability to change the state when driving forwards no mater which
part of the turn we are in.