X-Git-Url: https://git.piment-noir.org/?a=blobdiff_plain;f=src%2Flib%2FAdapterCommunication.cpp;h=e772d351cbd265fdf6a1a9d4b764edebd0f28e5e;hb=fdd91966a0d9d32b3e68cd91b6612840b80b227d;hp=661478396a58a8ce09f7d5ac992a45ffd27f7e0f;hpb=c02980af7d1e94a8f1de4df4572a551bb796bd5f;p=deb_libcec.git diff --git a/src/lib/AdapterCommunication.cpp b/src/lib/AdapterCommunication.cpp index 6614783..e772d35 100644 --- a/src/lib/AdapterCommunication.cpp +++ b/src/lib/AdapterCommunication.cpp @@ -56,29 +56,32 @@ CCECAdapterMessage::CCECAdapterMessage(const cec_command &command) // add source and destination push_back(MSGSTART); - push_escaped(MSGCODE_TRANSMIT); + push_escaped(command.opcode_set == 0 ? (uint8_t)MSGCODE_TRANSMIT_EOM : (uint8_t)MSGCODE_TRANSMIT); push_back(((uint8_t)command.initiator << 4) + (uint8_t)command.destination); push_back(MSGEND); // add opcode - push_back(MSGSTART); - push_escaped(command.parameters.empty() ? (uint8_t)MSGCODE_TRANSMIT_EOM : (uint8_t)MSGCODE_TRANSMIT); - push_back((uint8_t) command.opcode); - push_back(MSGEND); - - // add parameters - for (int8_t iPtr = 0; iPtr < command.parameters.size; iPtr++) + if (command.opcode_set == 1) { push_back(MSGSTART); + push_escaped(command.parameters.IsEmpty() ? (uint8_t)MSGCODE_TRANSMIT_EOM : (uint8_t)MSGCODE_TRANSMIT); + push_back((uint8_t) command.opcode); + push_back(MSGEND); - if (iPtr == command.parameters.size - 1) - push_escaped( MSGCODE_TRANSMIT_EOM); - else - push_escaped(MSGCODE_TRANSMIT); + // add parameters + for (int8_t iPtr = 0; iPtr < command.parameters.size; iPtr++) + { + push_back(MSGSTART); - push_escaped(command.parameters[iPtr]); + if (iPtr == command.parameters.size - 1) + push_escaped( MSGCODE_TRANSMIT_EOM); + else + push_escaped(MSGCODE_TRANSMIT); - push_back(MSGEND); + push_escaped(command.parameters[iPtr]); + + push_back(MSGEND); + } } // set timeout @@ -224,15 +227,15 @@ bool CCECAdapterMessage::is_error(void) const code == MSGCODE_TRANSMIT_FAILED_TIMEOUT_LINE); } -void CCECAdapterMessage::push_escaped(int16_t byte) +void CCECAdapterMessage::push_escaped(uint8_t byte) { if (byte >= MSGESC && byte != MSGSTART) { push_back(MSGESC); - push_back((uint8_t) (byte - ESCOFFSET)); + push_back(byte - ESCOFFSET); } else - push_back((uint8_t) byte); + push_back(byte); } CAdapterCommunication::CAdapterCommunication(CLibCEC *controller) :