Update servo.cpp

Disable DEBUG