Disable the DEBUG in servo.cpp