Servo driver/reader with atmega 168/328