Reworked servo.js