Huge changes

Lots of changes. All states implemented for course with modifications
for consistent errors, 90 left and right turns and 180 right done with
odometry, and wall following code updated with full PD controller.