Don't send floats to EBB for servo
Add debug mode setting and switch for logging all serial commands