Final version of driving in a square and testing 90 degree turns