added calibrateServo() to find the false origin of the servo. Doesn't fully work.