Changed turn method to correct heading and position before making the
turn.