fixed servoWrite method
add tests for init, move, min, max and center