Friction Fix and driveToPoint()