Commit | Line | Data |
---|---|---|
a8f0bd18 LOK |
1 | /* |
2 | * This file is part of the libCEC(R) library. | |
3 | * | |
4 | * libCEC(R) is Copyright (C) 2011 Pulse-Eight Limited. All rights reserved. | |
5 | * libCEC(R) is an original work, containing original code. | |
6 | * | |
7 | * libCEC(R) is a trademark of Pulse-Eight Limited. | |
8 | * | |
9 | * This program is dual-licensed; you can redistribute it and/or modify | |
10 | * it under the terms of the GNU General Public License as published by | |
11 | * the Free Software Foundation; either version 2 of the License, or | |
12 | * (at your option) any later version. | |
13 | * | |
14 | * This program is distributed in the hope that it will be useful, | |
15 | * but WITHOUT ANY WARRANTY; without even the implied warranty of | |
16 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the | |
17 | * GNU General Public License for more details. | |
18 | * | |
19 | * You should have received a copy of the GNU General Public License | |
20 | * along with this program; if not, write to the Free Software | |
21 | * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. | |
22 | * | |
23 | * | |
24 | * Alternatively, you can license this library under a commercial license, | |
25 | * please contact Pulse-Eight Licensing for more information. | |
26 | * | |
27 | * For more information contact: | |
28 | * Pulse-Eight Licensing <license@pulse-eight.com> | |
29 | * http://www.pulse-eight.com/ | |
30 | * http://www.pulse-eight.net/ | |
31 | */ | |
32 | ||
828682d3 | 33 | #include "AdapterCommunication.h" |
2abe74eb | 34 | |
ef7696f5 | 35 | #include "AdapterMessage.h" |
b5f787b9 LOK |
36 | #include "../CECProcessor.h" |
37 | #include "../platform/serialport/serialport.h" | |
5477a250 | 38 | #include "../LibCEC.h" |
a8f0bd18 LOK |
39 | |
40 | using namespace std; | |
41 | using namespace CEC; | |
f00ff009 | 42 | using namespace PLATFORM; |
a8f0bd18 | 43 | |
1113cb7d | 44 | CAdapterCommunication::CAdapterCommunication(CCECProcessor *processor) : |
12027dbe | 45 | m_port(NULL), |
a171d2fd | 46 | m_processor(processor), |
1fc16cfd LOK |
47 | m_iLineTimeout(0), |
48 | m_iFirmwareVersion(CEC_FW_VERSION_UNKNOWN) | |
a8f0bd18 | 49 | { |
f00ff009 | 50 | m_port = new PLATFORM::CSerialPort; |
a8f0bd18 LOK |
51 | } |
52 | ||
828682d3 | 53 | CAdapterCommunication::~CAdapterCommunication(void) |
a8f0bd18 | 54 | { |
12027dbe LOK |
55 | Close(); |
56 | ||
57 | if (m_port) | |
58 | { | |
59 | delete m_port; | |
60 | m_port = NULL; | |
61 | } | |
a8f0bd18 LOK |
62 | } |
63 | ||
25701fa6 | 64 | bool CAdapterCommunication::Open(const char *strPort, uint16_t iBaudRate /* = 38400 */, uint32_t iTimeoutMs /* = 10000 */) |
a8f0bd18 | 65 | { |
7b494bea LOK |
66 | uint64_t iNow = GetTimeMs(); |
67 | uint64_t iTimeout = iNow + iTimeoutMs; | |
68 | ||
f00ff009 | 69 | CLockObject lock(m_mutex); |
7b494bea | 70 | |
13fd6a66 LOK |
71 | if (!m_port) |
72 | { | |
5477a250 | 73 | CLibCEC::AddLog(CEC_LOG_ERROR, "port is NULL"); |
a8f0bd18 | 74 | return false; |
13fd6a66 LOK |
75 | } |
76 | ||
77 | if (IsOpen()) | |
78 | { | |
5477a250 | 79 | CLibCEC::AddLog(CEC_LOG_ERROR, "port is already open"); |
7b494bea | 80 | return true; |
13fd6a66 | 81 | } |
a8f0bd18 | 82 | |
7b494bea LOK |
83 | CStdString strError; |
84 | bool bConnected(false); | |
85 | while (!bConnected && iNow < iTimeout) | |
86 | { | |
d956c02e | 87 | if ((bConnected = m_port->Open(strPort, iBaudRate)) == false) |
7b494bea LOK |
88 | { |
89 | strError.Format("error opening serial port '%s': %s", strPort, m_port->GetError().c_str()); | |
90 | Sleep(250); | |
91 | iNow = GetTimeMs(); | |
92 | } | |
93 | } | |
94 | ||
95 | if (!bConnected) | |
a8f0bd18 | 96 | { |
5477a250 | 97 | CLibCEC::AddLog(CEC_LOG_ERROR, strError); |
a8f0bd18 LOK |
98 | return false; |
99 | } | |
100 | ||
5477a250 | 101 | CLibCEC::AddLog(CEC_LOG_DEBUG, "connection opened"); |
a8f0bd18 LOK |
102 | |
103 | //clear any input bytes | |
aee82ba0 LOK |
104 | uint8_t buff[1]; |
105 | while (m_port->Read(buff, 1, 5) == 1) {} | |
a8f0bd18 | 106 | |
828682d3 | 107 | if (CreateThread()) |
a8f0bd18 | 108 | { |
5477a250 | 109 | CLibCEC::AddLog(CEC_LOG_DEBUG, "communication thread started"); |
a8f0bd18 LOK |
110 | return true; |
111 | } | |
112 | else | |
113 | { | |
5477a250 | 114 | CLibCEC::AddLog(CEC_LOG_ERROR, "could not create a communication thread"); |
a8f0bd18 LOK |
115 | } |
116 | ||
117 | return false; | |
118 | } | |
119 | ||
828682d3 | 120 | void CAdapterCommunication::Close(void) |
a8f0bd18 | 121 | { |
f00ff009 | 122 | CLockObject lock(m_mutex); |
d5bffd3c | 123 | m_rcvCondition.Broadcast(); |
b9eea66d | 124 | StopThread(); |
a8f0bd18 LOK |
125 | } |
126 | ||
828682d3 | 127 | void *CAdapterCommunication::Process(void) |
a8f0bd18 | 128 | { |
13fd6a66 | 129 | while (!IsStopped()) |
a8f0bd18 | 130 | { |
9e1cfa5c | 131 | ReadFromDevice(50); |
c02980af | 132 | Sleep(5); |
3c53ac93 | 133 | WriteNextCommand(); |
a8f0bd18 LOK |
134 | } |
135 | ||
ef7696f5 | 136 | CCECAdapterMessage *msg(NULL); |
a0878ee3 LOK |
137 | if (m_outBuffer.Pop(msg)) |
138 | msg->condition.Broadcast(); | |
139 | ||
a8f0bd18 LOK |
140 | return NULL; |
141 | } | |
142 | ||
28352a04 | 143 | bool CAdapterCommunication::Write(CCECAdapterMessage *data) |
3c53ac93 | 144 | { |
5dcf9f25 LOK |
145 | bool bReturn(false); |
146 | ||
147 | CLockObject lock(data->mutex); | |
148 | data->state = ADAPTER_MESSAGE_STATE_WAITING_TO_BE_SENT; | |
3c53ac93 | 149 | m_outBuffer.Push(data); |
5dcf9f25 LOK |
150 | data->condition.Wait(data->mutex); |
151 | ||
152 | if (data->state != ADAPTER_MESSAGE_STATE_SENT) | |
153 | { | |
5477a250 | 154 | CLibCEC::AddLog(CEC_LOG_ERROR, "command was not sent"); |
5dcf9f25 | 155 | } |
b2f0b1ab | 156 | else if (data->expectControllerAck) |
5dcf9f25 | 157 | { |
b2f0b1ab | 158 | bReturn = WaitForAck(*data); |
4060d525 LOK |
159 | if (bReturn) |
160 | { | |
161 | if (data->isTransmission) | |
162 | data->state = ADAPTER_MESSAGE_STATE_SENT_ACKED; | |
163 | } | |
164 | else | |
165 | { | |
166 | data->state = ADAPTER_MESSAGE_STATE_SENT_NOT_ACKED; | |
5477a250 | 167 | CLibCEC::AddLog(CEC_LOG_DEBUG, "did not receive ack"); |
4060d525 | 168 | } |
5dcf9f25 LOK |
169 | } |
170 | else | |
171 | { | |
4060d525 | 172 | bReturn = true; |
5dcf9f25 LOK |
173 | } |
174 | ||
175 | return bReturn; | |
a8f0bd18 LOK |
176 | } |
177 | ||
220537f2 | 178 | bool CAdapterCommunication::Read(CCECAdapterMessage &msg, uint32_t iTimeout) |
a8f0bd18 | 179 | { |
f00ff009 | 180 | CLockObject lock(m_mutex); |
a8f0bd18 | 181 | |
ef7696f5 | 182 | msg.Clear(); |
50aa01e6 LOK |
183 | uint64_t iNow = GetTimeMs(); |
184 | uint64_t iTarget = iNow + iTimeout; | |
185 | bool bGotFullMessage(false); | |
186 | bool bNextIsEscaped(false); | |
187 | bool bGotStart(false); | |
a8f0bd18 | 188 | |
50aa01e6 | 189 | while(!bGotFullMessage && iNow < iTarget) |
a8f0bd18 | 190 | { |
50aa01e6 LOK |
191 | uint8_t buf = 0; |
192 | if (!m_inBuffer.Pop(buf)) | |
a8f0bd18 | 193 | { |
f00ff009 | 194 | if (!m_rcvCondition.Wait(m_mutex, (uint32_t) (iTarget - iNow))) |
50aa01e6 | 195 | return false; |
a8f0bd18 | 196 | } |
a8f0bd18 | 197 | |
50aa01e6 | 198 | if (!bGotStart) |
a8f0bd18 | 199 | { |
50aa01e6 LOK |
200 | if (buf == MSGSTART) |
201 | bGotStart = true; | |
202 | continue; | |
a8f0bd18 | 203 | } |
50aa01e6 | 204 | else if (buf == MSGSTART) //we found a msgstart before msgend, this is not right, remove |
a8f0bd18 | 205 | { |
ef7696f5 | 206 | if (msg.Size() > 0) |
5477a250 | 207 | CLibCEC::AddLog(CEC_LOG_WARNING, "received MSGSTART before MSGEND, removing previous buffer contents"); |
ef7696f5 | 208 | msg.Clear(); |
50aa01e6 | 209 | bGotStart = true; |
a8f0bd18 | 210 | } |
a8f0bd18 | 211 | |
50aa01e6 | 212 | if (buf == MSGEND) |
a8f0bd18 | 213 | { |
50aa01e6 | 214 | bGotFullMessage = true; |
a8f0bd18 | 215 | } |
50aa01e6 LOK |
216 | else if (bNextIsEscaped) |
217 | { | |
ef7696f5 | 218 | msg.PushBack(buf + (uint8_t)ESCOFFSET); |
50aa01e6 LOK |
219 | bNextIsEscaped = false; |
220 | } | |
221 | else if (buf == MSGESC) | |
222 | bNextIsEscaped = true; | |
223 | else | |
ef7696f5 | 224 | msg.PushBack(buf); |
a8f0bd18 LOK |
225 | } |
226 | ||
0e31a62c | 227 | if (bGotFullMessage) |
5dcf9f25 | 228 | msg.state = ADAPTER_MESSAGE_STATE_INCOMING; |
0e31a62c | 229 | |
50aa01e6 | 230 | return bGotFullMessage; |
a8f0bd18 LOK |
231 | } |
232 | ||
828682d3 | 233 | std::string CAdapterCommunication::GetError(void) const |
a8f0bd18 LOK |
234 | { |
235 | return m_port->GetError(); | |
236 | } | |
2abe74eb LOK |
237 | |
238 | bool CAdapterCommunication::StartBootloader(void) | |
239 | { | |
28352a04 | 240 | bool bReturn(false); |
2abe74eb | 241 | if (!IsRunning()) |
28352a04 | 242 | return bReturn; |
2abe74eb | 243 | |
5477a250 | 244 | CLibCEC::AddLog(CEC_LOG_DEBUG, "starting the bootloader"); |
28352a04 | 245 | CCECAdapterMessage *output = new CCECAdapterMessage; |
25701fa6 | 246 | |
ef7696f5 LOK |
247 | output->PushBack(MSGSTART); |
248 | output->PushEscaped(MSGCODE_START_BOOTLOADER); | |
249 | output->PushBack(MSGEND); | |
5dcf9f25 | 250 | output->isTransmission = false; |
71c4a2f5 | 251 | output->expectControllerAck = false; |
2abe74eb | 252 | |
5dcf9f25 | 253 | if ((bReturn = Write(output)) == false) |
5477a250 | 254 | CLibCEC::AddLog(CEC_LOG_ERROR, "could not start the bootloader"); |
28352a04 LOK |
255 | delete output; |
256 | ||
257 | return bReturn; | |
2abe74eb LOK |
258 | } |
259 | ||
2abe74eb LOK |
260 | bool CAdapterCommunication::PingAdapter(void) |
261 | { | |
28352a04 | 262 | bool bReturn(false); |
2abe74eb | 263 | if (!IsRunning()) |
28352a04 | 264 | return bReturn; |
2abe74eb | 265 | |
5477a250 | 266 | CLibCEC::AddLog(CEC_LOG_DEBUG, "sending ping"); |
28352a04 | 267 | CCECAdapterMessage *output = new CCECAdapterMessage; |
25701fa6 | 268 | |
ef7696f5 LOK |
269 | output->PushBack(MSGSTART); |
270 | output->PushEscaped(MSGCODE_PING); | |
271 | output->PushBack(MSGEND); | |
5dcf9f25 | 272 | output->isTransmission = false; |
2abe74eb | 273 | |
5dcf9f25 | 274 | if ((bReturn = Write(output)) == false) |
5477a250 | 275 | CLibCEC::AddLog(CEC_LOG_ERROR, "could not ping the adapter"); |
28352a04 LOK |
276 | delete output; |
277 | ||
278 | return bReturn; | |
2abe74eb | 279 | } |
13fd6a66 | 280 | |
1fc16cfd LOK |
281 | uint16_t CAdapterCommunication::GetFirmwareVersion(void) |
282 | { | |
283 | uint16_t iReturn(m_iFirmwareVersion); | |
284 | if (!IsRunning()) | |
285 | return iReturn; | |
286 | ||
287 | if (iReturn == CEC_FW_VERSION_UNKNOWN) | |
288 | { | |
5477a250 | 289 | CLibCEC::AddLog(CEC_LOG_DEBUG, "requesting the firmware version"); |
1fc16cfd LOK |
290 | CCECAdapterMessage *output = new CCECAdapterMessage; |
291 | ||
292 | output->PushBack(MSGSTART); | |
293 | output->PushEscaped(MSGCODE_FIRMWARE_VERSION); | |
294 | output->PushBack(MSGEND); | |
295 | output->isTransmission = false; | |
296 | output->expectControllerAck = false; | |
297 | ||
298 | SendMessageToAdapter(output); | |
299 | delete output; | |
300 | ||
301 | CCECAdapterMessage input; | |
302 | if (!Read(input, CEC_DEFAULT_TRANSMIT_WAIT) || input.Message() != MSGCODE_FIRMWARE_VERSION || input.Size() != 3) | |
5477a250 | 303 | CLibCEC::AddLog(CEC_LOG_ERROR, "no or invalid firmware version"); |
1fc16cfd LOK |
304 | else |
305 | { | |
306 | m_iFirmwareVersion = (input[1] << 8 | input[2]); | |
307 | iReturn = m_iFirmwareVersion; | |
308 | } | |
309 | } | |
310 | ||
311 | return iReturn; | |
312 | } | |
313 | ||
a171d2fd LOK |
314 | bool CAdapterCommunication::SetLineTimeout(uint8_t iTimeout) |
315 | { | |
316 | bool bReturn(m_iLineTimeout != iTimeout); | |
317 | ||
318 | if (!bReturn) | |
319 | { | |
320 | CCECAdapterMessage *output = new CCECAdapterMessage; | |
321 | ||
ef7696f5 LOK |
322 | output->PushBack(MSGSTART); |
323 | output->PushEscaped(MSGCODE_TRANSMIT_IDLETIME); | |
324 | output->PushEscaped(iTimeout); | |
325 | output->PushBack(MSGEND); | |
5dcf9f25 | 326 | output->isTransmission = false; |
a171d2fd LOK |
327 | |
328 | if ((bReturn = Write(output)) == false) | |
5477a250 | 329 | CLibCEC::AddLog(CEC_LOG_ERROR, "could not set the idletime"); |
a171d2fd LOK |
330 | delete output; |
331 | } | |
332 | ||
333 | return bReturn; | |
334 | } | |
335 | ||
5dcf9f25 LOK |
336 | bool CAdapterCommunication::SetAckMask(uint16_t iMask) |
337 | { | |
338 | bool bReturn(false); | |
339 | CStdString strLog; | |
340 | strLog.Format("setting ackmask to %2x", iMask); | |
5477a250 | 341 | CLibCEC::AddLog(CEC_LOG_DEBUG, strLog.c_str()); |
5dcf9f25 LOK |
342 | |
343 | CCECAdapterMessage *output = new CCECAdapterMessage; | |
344 | ||
345 | output->PushBack(MSGSTART); | |
346 | output->PushEscaped(MSGCODE_SET_ACK_MASK); | |
347 | output->PushEscaped(iMask >> 8); | |
348 | output->PushEscaped((uint8_t)iMask); | |
349 | output->PushBack(MSGEND); | |
350 | output->isTransmission = false; | |
351 | ||
352 | if ((bReturn = Write(output)) == false) | |
5477a250 | 353 | CLibCEC::AddLog(CEC_LOG_ERROR, "could not set the ackmask"); |
5dcf9f25 LOK |
354 | delete output; |
355 | ||
356 | return bReturn; | |
357 | } | |
358 | ||
f00ff009 | 359 | bool CAdapterCommunication::IsOpen(void) |
13fd6a66 | 360 | { |
b9eea66d | 361 | return !IsStopped() && m_port->IsOpen() && IsRunning(); |
13fd6a66 | 362 | } |
ef7696f5 | 363 | |
b2f0b1ab | 364 | bool CAdapterCommunication::WaitForAck(CCECAdapterMessage &message) |
6729ac71 LOK |
365 | { |
366 | bool bError(false); | |
367 | bool bTransmitSucceeded(false); | |
b2f0b1ab | 368 | uint8_t iPacketsLeft(message.Size() / 4); |
6729ac71 LOK |
369 | |
370 | int64_t iNow = GetTimeMs(); | |
b2f0b1ab | 371 | int64_t iTargetTime = iNow + message.transmit_timeout; |
6729ac71 | 372 | |
b2f0b1ab | 373 | while (!bTransmitSucceeded && !bError && (message.transmit_timeout == 0 || iNow < iTargetTime)) |
6729ac71 LOK |
374 | { |
375 | CCECAdapterMessage msg; | |
e2800c15 | 376 | int32_t iWait = (int32_t)(iTargetTime - iNow); |
b2f0b1ab | 377 | if (iWait <= 5 || message.transmit_timeout <= 5) |
e2800c15 | 378 | iWait = CEC_DEFAULT_TRANSMIT_WAIT; |
6729ac71 | 379 | |
e2800c15 | 380 | if (!Read(msg, iWait)) |
6729ac71 LOK |
381 | { |
382 | iNow = GetTimeMs(); | |
383 | continue; | |
384 | } | |
385 | ||
386 | if (msg.Message() == MSGCODE_FRAME_START && msg.IsACK()) | |
387 | { | |
388 | m_processor->HandlePoll(msg.Initiator(), msg.Destination()); | |
389 | iNow = GetTimeMs(); | |
390 | continue; | |
391 | } | |
392 | ||
393 | if (msg.Message() == MSGCODE_RECEIVE_FAILED && | |
394 | m_processor->HandleReceiveFailed()) | |
395 | { | |
396 | iNow = GetTimeMs(); | |
397 | continue; | |
398 | } | |
399 | ||
400 | bError = msg.IsError(); | |
401 | if (bError) | |
402 | { | |
b2f0b1ab | 403 | message.reply = msg.Message(); |
5477a250 | 404 | CLibCEC::AddLog(CEC_LOG_DEBUG, msg.ToString()); |
6729ac71 LOK |
405 | } |
406 | else | |
407 | { | |
408 | switch(msg.Message()) | |
409 | { | |
410 | case MSGCODE_COMMAND_ACCEPTED: | |
5477a250 | 411 | CLibCEC::AddLog(CEC_LOG_DEBUG, msg.ToString()); |
6729ac71 LOK |
412 | if (iPacketsLeft > 0) |
413 | iPacketsLeft--; | |
b2f0b1ab | 414 | if (!message.isTransmission && iPacketsLeft == 0) |
5dcf9f25 | 415 | bTransmitSucceeded = true; |
6729ac71 LOK |
416 | break; |
417 | case MSGCODE_TRANSMIT_SUCCEEDED: | |
5477a250 | 418 | CLibCEC::AddLog(CEC_LOG_DEBUG, msg.ToString()); |
6729ac71 LOK |
419 | bTransmitSucceeded = (iPacketsLeft == 0); |
420 | bError = !bTransmitSucceeded; | |
b2f0b1ab | 421 | message.reply = MSGCODE_TRANSMIT_SUCCEEDED; |
6729ac71 LOK |
422 | break; |
423 | default: | |
424 | // ignore other data while waiting | |
425 | break; | |
426 | } | |
427 | ||
428 | iNow = GetTimeMs(); | |
429 | } | |
430 | } | |
431 | ||
432 | return bTransmitSucceeded && !bError; | |
433 | } | |
434 | ||
ef7696f5 LOK |
435 | void CAdapterCommunication::AddData(uint8_t *data, uint8_t iLen) |
436 | { | |
437 | CLockObject lock(m_mutex); | |
438 | for (uint8_t iPtr = 0; iPtr < iLen; iPtr++) | |
439 | m_inBuffer.Push(data[iPtr]); | |
440 | ||
441 | m_rcvCondition.Signal(); | |
442 | } | |
443 | ||
444 | bool CAdapterCommunication::ReadFromDevice(uint32_t iTimeout) | |
445 | { | |
446 | int32_t iBytesRead; | |
447 | uint8_t buff[1024]; | |
448 | if (!m_port) | |
449 | return false; | |
450 | ||
1fc16cfd | 451 | CLockObject lock(m_mutex); |
ef7696f5 LOK |
452 | iBytesRead = m_port->Read(buff, sizeof(buff), iTimeout); |
453 | if (iBytesRead < 0 || iBytesRead > 256) | |
454 | { | |
455 | CStdString strError; | |
456 | strError.Format("error reading from serial port: %s", m_port->GetError().c_str()); | |
5477a250 | 457 | CLibCEC::AddLog(CEC_LOG_ERROR, strError); |
ef7696f5 LOK |
458 | return false; |
459 | } | |
460 | else if (iBytesRead > 0) | |
461 | AddData(buff, (uint8_t) iBytesRead); | |
462 | ||
463 | return iBytesRead > 0; | |
464 | } | |
465 | ||
466 | void CAdapterCommunication::SendMessageToAdapter(CCECAdapterMessage *msg) | |
467 | { | |
1fc16cfd | 468 | CLockObject adapterLock(m_mutex); |
ef7696f5 LOK |
469 | CLockObject lock(msg->mutex); |
470 | if (m_port->Write(msg->packet.data, msg->Size()) != (int32_t) msg->Size()) | |
471 | { | |
472 | CStdString strError; | |
473 | strError.Format("error writing to serial port: %s", m_port->GetError().c_str()); | |
5477a250 | 474 | CLibCEC::AddLog(CEC_LOG_ERROR, strError); |
ef7696f5 LOK |
475 | msg->state = ADAPTER_MESSAGE_STATE_ERROR; |
476 | } | |
477 | else | |
478 | { | |
5477a250 | 479 | CLibCEC::AddLog(CEC_LOG_DEBUG, "command sent"); |
ef7696f5 LOK |
480 | msg->state = ADAPTER_MESSAGE_STATE_SENT; |
481 | } | |
482 | msg->condition.Signal(); | |
483 | } | |
484 | ||
485 | void CAdapterCommunication::WriteNextCommand(void) | |
486 | { | |
487 | CCECAdapterMessage *msg(NULL); | |
488 | if (m_outBuffer.Pop(msg)) | |
489 | SendMessageToAdapter(msg); | |
490 | } |