Taking DISABLE_ROBOTCAMPUS_COMMANDS in account
Moving servos commands to servos_commands.cpp