void HCSR04::AcceptCommand(const Command& command) { unsigned char commandId = command.GetCommandId(); switch(commandId) { case SENSE: Sense(); break; default: break; } }