Implement receiving and sending SERIAL_CONTROL message Use global defined print function instead of Serial.printf