X-Git-Url: https://git.piment-noir.org/?a=blobdiff_plain;f=src%2Flib%2FAdapterCommunication.cpp;h=2286a01e57080e8c12663e7b6c5a48d0d628f1c0;hb=e0407d3d1acb140e344b95c248259474a44ad89b;hp=743f00d66e6caefe6bf0d079248a641e7d691bd3;hpb=5a1e87c8d9a1d8a6b8dbf8b7d1738395fdb6b856;p=deb_libcec.git diff --git a/src/lib/AdapterCommunication.cpp b/src/lib/AdapterCommunication.cpp index 743f00d..2286a01 100644 --- a/src/lib/AdapterCommunication.cpp +++ b/src/lib/AdapterCommunication.cpp @@ -80,23 +80,159 @@ CCECAdapterMessage::CCECAdapterMessage(const cec_command &command) push_back(MSGEND); } + + // set timeout + transmit_timeout = command.transmit_timeout; } CCECAdapterMessage &CCECAdapterMessage::operator =(const CCECAdapterMessage &msg) { packet = msg.packet; + state = msg.state; return *this; } +CStdString CCECAdapterMessage::MessageCodeAsString(void) const +{ + CStdString strMsg; + switch (message()) + { + case MSGCODE_NOTHING: + strMsg = "NOTHING"; + break; + case MSGCODE_PING: + strMsg = "PING"; + break; + case MSGCODE_TIMEOUT_ERROR: + strMsg = "TIMEOUT"; + break; + case MSGCODE_HIGH_ERROR: + strMsg = "HIGH_ERROR"; + break; + case MSGCODE_LOW_ERROR: + strMsg = "LOW_ERROR"; + break; + case MSGCODE_FRAME_START: + strMsg = "FRAME_START"; + break; + case MSGCODE_FRAME_DATA: + strMsg = "FRAME_DATA"; + break; + case MSGCODE_RECEIVE_FAILED: + strMsg = "RECEIVE_FAILED"; + break; + case MSGCODE_COMMAND_ACCEPTED: + strMsg = "COMMAND_ACCEPTED"; + break; + case MSGCODE_COMMAND_REJECTED: + strMsg = "COMMAND_REJECTED"; + break; + case MSGCODE_SET_ACK_MASK: + strMsg = "SET_ACK_MASK"; + break; + case MSGCODE_TRANSMIT: + strMsg = "TRANSMIT"; + break; + case MSGCODE_TRANSMIT_EOM: + strMsg = "TRANSMIT_EOM"; + break; + case MSGCODE_TRANSMIT_IDLETIME: + strMsg = "TRANSMIT_IDLETIME"; + break; + case MSGCODE_TRANSMIT_ACK_POLARITY: + strMsg = "TRANSMIT_ACK_POLARITY"; + break; + case MSGCODE_TRANSMIT_LINE_TIMEOUT: + strMsg = "TRANSMIT_LINE_TIMEOUT"; + break; + case MSGCODE_TRANSMIT_SUCCEEDED: + strMsg = "TRANSMIT_SUCCEEDED"; + break; + case MSGCODE_TRANSMIT_FAILED_LINE: + strMsg = "TRANSMIT_FAILED_LINE"; + break; + case MSGCODE_TRANSMIT_FAILED_ACK: + strMsg = "TRANSMIT_FAILED_ACK"; + break; + case MSGCODE_TRANSMIT_FAILED_TIMEOUT_DATA: + strMsg = "TRANSMIT_FAILED_TIMEOUT_DATA"; + break; + case MSGCODE_TRANSMIT_FAILED_TIMEOUT_LINE: + strMsg = "TRANSMIT_FAILED_TIMEOUT_LINE"; + break; + case MSGCODE_FIRMWARE_VERSION: + strMsg = "FIRMWARE_VERSION"; + break; + case MSGCODE_START_BOOTLOADER: + strMsg = "START_BOOTLOADER"; + break; + case MSGCODE_FRAME_EOM: + strMsg = "FRAME_EOM"; + break; + case MSGCODE_FRAME_ACK: + strMsg = "FRAME_ACK"; + break; + } + + return strMsg; +} + +CStdString CCECAdapterMessage::ToString(void) const +{ + CStdString strMsg; + strMsg = MessageCodeAsString(); + + switch (message()) + { + case MSGCODE_TIMEOUT_ERROR: + case MSGCODE_HIGH_ERROR: + case MSGCODE_LOW_ERROR: + { + int iLine = (size() >= 3) ? (at(1) << 8) | at(2) : 0; + uint32_t iTime = (size() >= 7) ? (at(3) << 24) | (at(4) << 16) | (at(5) << 8) | at(6) : 0; + strMsg.AppendFormat(" line:%i", iLine); + strMsg.AppendFormat(" time:%u", iTime); + } + break; + case MSGCODE_FRAME_START: + if (size() >= 2) + strMsg.AppendFormat(" initiator:%1x destination:%1x ack:%s %s", initiator(), destination(), ack() ? "high" : "low", eom() ? "eom" : ""); + break; + case MSGCODE_FRAME_DATA: + if (size() >= 2) + strMsg.AppendFormat(" %02x %s", at(1), eom() ? "eom" : ""); + break; + default: + break; + } + + return strMsg; +} + +bool CCECAdapterMessage::is_error(void) const +{ + cec_adapter_messagecode code = message(); + return (code == MSGCODE_TIMEOUT_ERROR || + code == MSGCODE_HIGH_ERROR || + code == MSGCODE_LOW_ERROR || + code == MSGCODE_RECEIVE_FAILED || + code == MSGCODE_COMMAND_REJECTED || + code == MSGCODE_TRANSMIT_LINE_TIMEOUT || + code == MSGCODE_TRANSMIT_FAILED_LINE || + code == MSGCODE_TRANSMIT_FAILED_ACK || + code == MSGCODE_TRANSMIT_FAILED_TIMEOUT_DATA || + code == MSGCODE_TRANSMIT_FAILED_TIMEOUT_LINE); +} + void CCECAdapterMessage::push_escaped(int16_t byte) { if (byte >= MSGESC && byte != MSGSTART) { push_back(MSGESC); - push_back(byte - ESCOFFSET); + push_back((uint8_t) (byte - ESCOFFSET)); } else - push_back(byte); + push_back((uint8_t) byte); } CAdapterCommunication::CAdapterCommunication(CLibCEC *controller) : @@ -119,6 +255,7 @@ CAdapterCommunication::~CAdapterCommunication(void) bool CAdapterCommunication::Open(const char *strPort, uint16_t iBaudRate /* = 38400 */, uint32_t iTimeoutMs /* = 10000 */) { + CLockObject lock(&m_mutex); if (!m_port) { m_controller->AddLog(CEC_LOG_ERROR, "port is NULL"); @@ -146,7 +283,8 @@ bool CAdapterCommunication::Open(const char *strPort, uint16_t iBaudRate /* = 38 if (CreateThread()) { - m_controller->AddLog(CEC_LOG_DEBUG, "communication thread created"); + m_startCondition.Wait(&m_mutex); + m_controller->AddLog(CEC_LOG_DEBUG, "communication thread started"); return true; } else @@ -159,18 +297,23 @@ bool CAdapterCommunication::Open(const char *strPort, uint16_t iBaudRate /* = 38 void CAdapterCommunication::Close(void) { - StopThread(); - + CLockObject lock(&m_mutex); + m_startCondition.Broadcast(); m_rcvCondition.Broadcast(); + StopThread(); } void *CAdapterCommunication::Process(void) { - m_controller->AddLog(CEC_LOG_DEBUG, "communication thread started"); + { + CLockObject lock(&m_mutex); + m_startCondition.Signal(); + } while (!IsStopped()) { ReadFromDevice(500); + Sleep(5); WriteNextCommand(); Sleep(5); } @@ -201,7 +344,7 @@ bool CAdapterCommunication::ReadFromDevice(uint32_t iTimeout) void CAdapterCommunication::AddData(uint8_t *data, uint8_t iLen) { - CLockObject lock(&m_bufferMutex); + CLockObject lock(&m_mutex); for (unsigned int iPtr = 0; iPtr < iLen; iPtr++) m_inBuffer.Push(data[iPtr]); @@ -213,29 +356,34 @@ void CAdapterCommunication::WriteNextCommand(void) CCECAdapterMessagePtr msg; if (m_outBuffer.Pop(msg)) { - if (m_port->Write(msg) != (int32_t) msg.get()->size()) + CLockObject lock(&msg->mutex); + if (m_port->Write(msg) != (int32_t) msg->size()) { CStdString strError; strError.Format("error writing to serial port: %s", m_port->GetError().c_str()); m_controller->AddLog(CEC_LOG_ERROR, strError); + msg->state = ADAPTER_MESSAGE_STATE_ERROR; } else { m_controller->AddLog(CEC_LOG_DEBUG, "command sent"); - CCondition::Sleep((uint32_t) msg.get()->size() * (uint32_t)24 /*data*/ + (uint32_t)5 /*start bit (4.5 ms)*/); + CCondition::Sleep((uint32_t) msg->size() * 24 /*data*/ + 5 /*start bit (4.5 ms)*/ + 10); + msg->state = ADAPTER_MESSAGE_STATE_SENT; } + msg->condition.Signal(); } } bool CAdapterCommunication::Write(CCECAdapterMessagePtr data) { + data->state = ADAPTER_MESSAGE_STATE_WAITING; m_outBuffer.Push(data); return true; } bool CAdapterCommunication::Read(CCECAdapterMessage &msg, uint32_t iTimeout) { - CLockObject lock(&m_bufferMutex); + CLockObject lock(&m_mutex); msg.clear(); uint64_t iNow = GetTimeMs(); @@ -249,7 +397,7 @@ bool CAdapterCommunication::Read(CCECAdapterMessage &msg, uint32_t iTimeout) uint8_t buf = 0; if (!m_inBuffer.Pop(buf)) { - if (!m_rcvCondition.Wait(&m_bufferMutex, iTarget - iNow)) + if (!m_rcvCondition.Wait(&m_mutex, (uint32_t) (iTarget - iNow))) return false; } @@ -281,6 +429,9 @@ bool CAdapterCommunication::Read(CCECAdapterMessage &msg, uint32_t iTimeout) msg.push_back(buf); } + if (bGotFullMessage) + msg.state = ADAPTER_MESSAGE_STATE_RECEIVED; + return bGotFullMessage; } @@ -310,32 +461,6 @@ bool CAdapterCommunication::StartBootloader(void) return true; } -bool CAdapterCommunication::SetAckMask(uint16_t iMask) -{ - if (!IsRunning()) - return false; - - CStdString strLog; - strLog.Format("setting ackmask to %2x", iMask); - m_controller->AddLog(CEC_LOG_DEBUG, strLog.c_str()); - - CCECAdapterMessagePtr output(new CCECAdapterMessage); - - output->push_back(MSGSTART); - output->push_escaped(MSGCODE_SET_ACK_MASK); - output->push_escaped(iMask >> 8); - output->push_escaped((uint8_t)iMask); - output->push_back(MSGEND); - - if (!Write(output)) - { - m_controller->AddLog(CEC_LOG_ERROR, "could not set the ackmask"); - return false; - } - - return true; -} - bool CAdapterCommunication::PingAdapter(void) { if (!IsRunning()) @@ -362,5 +487,5 @@ bool CAdapterCommunication::PingAdapter(void) bool CAdapterCommunication::IsOpen(void) const { - return !IsStopped() && m_port->IsOpen(); + return !IsStopped() && m_port->IsOpen() && IsRunning(); }