Fixed the driving code. Need to fix Pivot code. Top two quadrants turn left bottom right turns right and  bottom left deoes nothing.