cec: changed to use dlopen instead of static linkage. shuffled headers a bit. bumped...
[deb_libcec.git] / src / lib / CECProcessor.cpp
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
33 #include "CECProcessor.h"
34
35 #include "AdapterCommunication.h"
36 #include "LibCEC.h"
37 #include "util/StdString.h"
38 #include "platform/timeutils.h"
39
40 using namespace CEC;
41 using namespace std;
42
43 CCECProcessor::CCECProcessor(CLibCEC *controller, CAdapterCommunication *serComm, const char *strDeviceName, cec_logical_address iLogicalAddress /* = CECDEVICE_PLAYBACKDEVICE1 */, uint16_t iPhysicalAddress /* = CEC_DEFAULT_PHYSICAL_ADDRESS*/) :
44 m_physicaladdress(iPhysicalAddress),
45 m_iLogicalAddress(iLogicalAddress),
46 m_strDeviceName(strDeviceName),
47 m_communication(serComm),
48 m_controller(controller)
49 {
50 for (uint8_t iPtr = 0; iPtr < 16; iPtr++)
51 m_vendorIds[iPtr] = CEC_VENDOR_UNKNOWN;
52 for (uint8_t iPtr = 0; iPtr < 16; iPtr++)
53 m_vendorClasses[iPtr] = (uint8_t) 0;
54 }
55
56 CCECProcessor::~CCECProcessor(void)
57 {
58 StopThread();
59 m_communication = NULL;
60 m_controller = NULL;
61 }
62
63 bool CCECProcessor::Start(void)
64 {
65 if (!m_communication || !m_communication->IsOpen())
66 {
67 m_controller->AddLog(CEC_LOG_ERROR, "connection is closed");
68 return false;
69 }
70
71 if (!SetLogicalAddress(m_iLogicalAddress))
72 {
73 m_controller->AddLog(CEC_LOG_ERROR, "could not set the logical address");
74 return false;
75 }
76
77 if (CreateThread())
78 return true;
79 else
80 m_controller->AddLog(CEC_LOG_ERROR, "could not create a processor thread");
81
82 return false;
83 }
84
85 void *CCECProcessor::Process(void)
86 {
87 m_controller->AddLog(CEC_LOG_DEBUG, "processor thread started");
88
89 cec_command command;
90 cec_adapter_message msg;
91
92 while (!IsStopped())
93 {
94 bool bParseFrame(false);
95 command.clear();
96 msg.clear();
97
98 {
99 CLockObject lock(&m_mutex);
100 if (m_communication->IsOpen() && m_communication->Read(msg, 50))
101 bParseFrame = ParseMessage(msg) && !IsStopped();
102
103 if (bParseFrame)
104 command = m_currentframe;
105 }
106
107 if (bParseFrame)
108 ParseCommand(command);
109
110 m_controller->CheckKeypressTimeout();
111
112 if (!IsStopped())
113 Sleep(5);
114 }
115
116 return NULL;
117 }
118
119 bool CCECProcessor::PowerOnDevices(cec_logical_address address /* = CECDEVICE_TV */)
120 {
121 if (!IsRunning())
122 return false;
123
124 CStdString strLog;
125 strLog.Format("<< powering on device with logical address %d", (int8_t)address);
126 m_controller->AddLog(CEC_LOG_DEBUG, strLog.c_str());
127
128 cec_command command;
129 cec_command::format(command, m_iLogicalAddress, address, CEC_OPCODE_IMAGE_VIEW_ON);
130
131 return Transmit(command);
132 }
133
134 bool CCECProcessor::StandbyDevices(cec_logical_address address /* = CECDEVICE_BROADCAST */)
135 {
136 if (!IsRunning())
137 return false;
138
139 CStdString strLog;
140 strLog.Format("<< putting device with logical address %d in standby mode", (int8_t)address);
141 m_controller->AddLog(CEC_LOG_DEBUG, strLog.c_str());
142
143 cec_command command;
144 cec_command::format(command, m_iLogicalAddress, address, CEC_OPCODE_STANDBY);
145
146 return Transmit(command);
147 }
148
149 bool CCECProcessor::SetActiveView(void)
150 {
151 if (!IsRunning())
152 return false;
153
154 m_controller->AddLog(CEC_LOG_DEBUG, "<< setting active view");
155
156 cec_command command;
157 cec_command::format(command, m_iLogicalAddress, CECDEVICE_BROADCAST, CEC_OPCODE_ACTIVE_SOURCE);
158 command.parameters.push_back((m_physicaladdress >> 8) & 0xFF);
159 command.parameters.push_back(m_physicaladdress & 0xFF);
160
161 return Transmit(command);
162 }
163
164 bool CCECProcessor::SetInactiveView(void)
165 {
166 if (!IsRunning())
167 return false;
168
169 m_controller->AddLog(CEC_LOG_DEBUG, "<< setting inactive view");
170
171 cec_command command;
172 cec_command::format(command, m_iLogicalAddress, CECDEVICE_BROADCAST, CEC_OPCODE_INACTIVE_SOURCE);
173 command.parameters.push_back((m_physicaladdress >> 8) & 0xFF);
174 command.parameters.push_back(m_physicaladdress & 0xFF);
175
176 return Transmit(command);
177 }
178
179 void CCECProcessor::LogOutput(const cec_command &data)
180 {
181 CStdString txStr = "transmit ";
182 txStr.AppendFormat(" %02x", ((uint8_t)data.initiator << 4) + (uint8_t)data.destination);
183 txStr.AppendFormat(" %02x", (uint8_t)data.opcode);
184
185 for (uint8_t iPtr = 0; iPtr < data.parameters.size; iPtr++)
186 txStr.AppendFormat(" %02x", data.parameters[iPtr]);
187 m_controller->AddLog(CEC_LOG_DEBUG, txStr.c_str());
188 }
189
190 bool CCECProcessor::Transmit(const cec_command &data, bool bWaitForAck /* = true */)
191 {
192 LogOutput(data);
193
194 cec_adapter_message output;
195 output.clear();
196 CAdapterCommunication::FormatAdapterMessage(data, output);
197
198 return TransmitFormatted(output, bWaitForAck);
199 }
200
201 bool CCECProcessor::SetLogicalAddress(cec_logical_address iLogicalAddress)
202 {
203 CStdString strLog;
204 strLog.Format("<< setting logical address to %d", iLogicalAddress);
205 m_controller->AddLog(CEC_LOG_NOTICE, strLog.c_str());
206
207 m_iLogicalAddress = iLogicalAddress;
208 return m_communication && m_communication->SetAckMask(0x1 << (uint8_t)m_iLogicalAddress);
209 }
210
211 bool CCECProcessor::TransmitFormatted(const cec_adapter_message &data, bool bWaitForAck /* = true */)
212 {
213 CLockObject lock(&m_mutex);
214 if (!m_communication || !m_communication->Write(data))
215 return false;
216
217 if (bWaitForAck)
218 {
219 uint64_t now = GetTimeMs();
220 uint64_t target = now + 1000;
221 bool bError(false);
222 bool bGotAck(false);
223
224 while (!bGotAck && now < target)
225 {
226 bGotAck = WaitForAck(&bError, (uint32_t) (target - now));
227 now = GetTimeMs();
228
229 if (bError && now < target)
230 {
231 m_controller->AddLog(CEC_LOG_ERROR, "retransmitting previous frame");
232 if (!m_communication->Write(data))
233 return false;
234 }
235 }
236 }
237
238 return true;
239 }
240
241 void CCECProcessor::TransmitAbort(cec_logical_address address, cec_opcode opcode, ECecAbortReason reason /* = CEC_ABORT_REASON_UNRECOGNIZED_OPCODE */)
242 {
243 m_controller->AddLog(CEC_LOG_DEBUG, "<< transmitting abort message");
244
245 cec_command command;
246 cec_command::format(command, m_iLogicalAddress, address, CEC_OPCODE_FEATURE_ABORT);
247 command.parameters.push_back((uint8_t)opcode);
248 command.parameters.push_back((uint8_t)reason);
249
250 Transmit(command);
251 }
252
253 void CCECProcessor::ReportCECVersion(cec_logical_address address /* = CECDEVICE_TV */)
254 {
255 m_controller->AddLog(CEC_LOG_NOTICE, "<< reporting CEC version as 1.3a");
256
257 cec_command command;
258 cec_command::format(command, m_iLogicalAddress, address, CEC_OPCODE_CEC_VERSION);
259 command.parameters.push_back(CEC_VERSION_1_3A);
260
261 Transmit(command);
262 }
263
264 void CCECProcessor::ReportPowerState(cec_logical_address address /*= CECDEVICE_TV */, bool bOn /* = true */)
265 {
266 if (bOn)
267 m_controller->AddLog(CEC_LOG_NOTICE, "<< reporting \"On\" power status");
268 else
269 m_controller->AddLog(CEC_LOG_NOTICE, "<< reporting \"Off\" power status");
270
271 cec_command command;
272 cec_command::format(command, m_iLogicalAddress, address, CEC_OPCODE_REPORT_POWER_STATUS);
273 command.parameters.push_back(bOn ? (uint8_t) CEC_POWER_STATUS_ON : (uint8_t) CEC_POWER_STATUS_STANDBY);
274
275 Transmit(command);
276 }
277
278 void CCECProcessor::ReportMenuState(cec_logical_address address /* = CECDEVICE_TV */, bool bActive /* = true */)
279 {
280 if (bActive)
281 m_controller->AddLog(CEC_LOG_NOTICE, "<< reporting menu state as active");
282 else
283 m_controller->AddLog(CEC_LOG_NOTICE, "<< reporting menu state as inactive");
284
285 cec_command command;
286 cec_command::format(command, m_iLogicalAddress, address, CEC_OPCODE_MENU_STATUS);
287 command.parameters.push_back(bActive ? (uint8_t) CEC_MENU_STATE_ACTIVATED : (uint8_t) CEC_MENU_STATE_DEACTIVATED);
288
289 Transmit(command);
290 }
291
292 void CCECProcessor::ReportVendorID(cec_logical_address address /* = CECDEVICE_TV */)
293 {
294 m_controller->AddLog(CEC_LOG_NOTICE, "<< vendor ID requested, feature abort");
295 TransmitAbort(address, CEC_OPCODE_GIVE_DEVICE_VENDOR_ID);
296 }
297
298 void CCECProcessor::ReportOSDName(cec_logical_address address /* = CECDEVICE_TV */)
299 {
300 const char *osdname = m_strDeviceName.c_str();
301 CStdString strLog;
302 strLog.Format("<< reporting OSD name as %s", osdname);
303 m_controller->AddLog(CEC_LOG_NOTICE, strLog.c_str());
304
305 cec_command command;
306 cec_command::format(command, m_iLogicalAddress, address, CEC_OPCODE_SET_OSD_NAME);
307 for (unsigned int iPtr = 0; iPtr < strlen(osdname); iPtr++)
308 command.parameters.push_back(osdname[iPtr]);
309
310 Transmit(command);
311 }
312
313 void CCECProcessor::ReportPhysicalAddress(void)
314 {
315 CStdString strLog;
316 strLog.Format("<< reporting physical address as %04x", m_physicaladdress);
317 m_controller->AddLog(CEC_LOG_NOTICE, strLog.c_str());
318
319 cec_command command;
320 cec_command::format(command, m_iLogicalAddress, CECDEVICE_BROADCAST, CEC_OPCODE_REPORT_PHYSICAL_ADDRESS);
321 command.parameters.push_back((uint8_t) ((m_physicaladdress >> 8) & 0xFF));
322 command.parameters.push_back((uint8_t) (m_physicaladdress & 0xFF));
323
324 Transmit(command);
325 }
326
327 void CCECProcessor::BroadcastActiveSource(void)
328 {
329 m_controller->AddLog(CEC_LOG_NOTICE, "<< broadcasting active source");
330
331 cec_command command;
332 cec_command::format(command, m_iLogicalAddress, CECDEVICE_BROADCAST, CEC_OPCODE_ACTIVE_SOURCE);
333 command.parameters.push_back((uint8_t) ((m_physicaladdress >> 8) & 0xFF));
334 command.parameters.push_back((uint8_t) (m_physicaladdress & 0xFF));
335
336 Transmit(command);
337 }
338
339 bool CCECProcessor::WaitForAck(bool *bError, uint32_t iTimeout /* = 1000 */)
340 {
341 bool bGotAck(false);
342 *bError = false;
343
344 int64_t iNow = GetTimeMs();
345 int64_t iTargetTime = iNow + (uint64_t) iTimeout;
346
347 while (!bGotAck && !*bError && (iTimeout == 0 || iNow < iTargetTime))
348 {
349 cec_adapter_message msg;
350 msg.clear();
351
352 if (!m_communication->Read(msg, iTimeout > 0 ? (int32_t)(iTargetTime - iNow) : 1000))
353 {
354 iNow = GetTimeMs();
355 continue;
356 }
357
358 switch (msg.message())
359 {
360 case MSGCODE_COMMAND_ACCEPTED:
361 m_controller->AddLog(CEC_LOG_DEBUG, "MSGCODE_COMMAND_ACCEPTED");
362 break;
363 case MSGCODE_TRANSMIT_SUCCEEDED:
364 m_controller->AddLog(CEC_LOG_DEBUG, "MSGCODE_TRANSMIT_SUCCEEDED");
365 bGotAck = true;
366 break;
367 case MSGCODE_RECEIVE_FAILED:
368 m_controller->AddLog(CEC_LOG_WARNING, "MSGCODE_RECEIVE_FAILED");
369 *bError = true;
370 break;
371 case MSGCODE_COMMAND_REJECTED:
372 m_controller->AddLog(CEC_LOG_WARNING, "MSGCODE_COMMAND_REJECTED");
373 *bError = true;
374 break;
375 case MSGCODE_TRANSMIT_FAILED_LINE:
376 m_controller->AddLog(CEC_LOG_WARNING, "MSGCODE_TRANSMIT_FAILED_LINE");
377 *bError = true;
378 break;
379 case MSGCODE_TRANSMIT_FAILED_ACK:
380 m_controller->AddLog(CEC_LOG_WARNING, "MSGCODE_TRANSMIT_FAILED_ACK");
381 *bError = true;
382 break;
383 case MSGCODE_TRANSMIT_FAILED_TIMEOUT_DATA:
384 m_controller->AddLog(CEC_LOG_WARNING, "MSGCODE_TRANSMIT_FAILED_TIMEOUT_DATA");
385 *bError = true;
386 break;
387 case MSGCODE_TRANSMIT_FAILED_TIMEOUT_LINE:
388 m_controller->AddLog(CEC_LOG_WARNING, "MSGCODE_TRANSMIT_FAILED_TIMEOUT_LINE");
389 *bError = true;
390 break;
391 default:
392 m_frameBuffer.Push(msg);
393 break;
394 }
395
396 iNow = GetTimeMs();
397 }
398
399 return bGotAck && !*bError;
400 }
401
402 bool CCECProcessor::ParseMessage(cec_adapter_message &msg)
403 {
404 bool bReturn(false);
405
406 if (msg.empty())
407 return bReturn;
408
409 CStdString logStr;
410
411 switch(msg.message())
412 {
413 case MSGCODE_NOTHING:
414 m_controller->AddLog(CEC_LOG_DEBUG, "MSGCODE_NOTHING");
415 break;
416 case MSGCODE_TIMEOUT_ERROR:
417 case MSGCODE_HIGH_ERROR:
418 case MSGCODE_LOW_ERROR:
419 {
420 if (msg.message() == MSGCODE_TIMEOUT_ERROR)
421 logStr = "MSGCODE_TIMEOUT";
422 else if (msg.message() == MSGCODE_HIGH_ERROR)
423 logStr = "MSGCODE_HIGH_ERROR";
424 else
425 logStr = "MSGCODE_LOW_ERROR";
426
427 int iLine = (msg.size() >= 3) ? (msg[1] << 8) | (msg[2]) : 0;
428 uint32_t iTime = (msg.size() >= 7) ? (msg[3] << 24) | (msg[4] << 16) | (msg[5] << 8) | (msg[6]) : 0;
429 logStr.AppendFormat(" line:%i", iLine);
430 logStr.AppendFormat(" time:%u", iTime);
431 m_controller->AddLog(CEC_LOG_WARNING, logStr.c_str());
432 }
433 break;
434 case MSGCODE_FRAME_START:
435 {
436 logStr = "MSGCODE_FRAME_START";
437 m_currentframe.clear();
438 if (msg.size() >= 2)
439 {
440 logStr.AppendFormat(" initiator:%u destination:%u ack:%s %s", msg.initiator(), msg.destination(), msg.ack() ? "high" : "low", msg.eom() ? "eom" : "");
441 m_currentframe.initiator = msg.initiator();
442 m_currentframe.destination = msg.destination();
443 m_currentframe.ack = msg.ack();
444 m_currentframe.eom = msg.eom();
445 }
446 m_controller->AddLog(CEC_LOG_DEBUG, logStr.c_str());
447 }
448 break;
449 case MSGCODE_FRAME_DATA:
450 {
451 logStr = "MSGCODE_FRAME_DATA";
452 if (msg.size() >= 2)
453 {
454 uint8_t iData = msg[1];
455 logStr.AppendFormat(" %02x", iData);
456 m_currentframe.push_back(iData);
457 }
458 m_controller->AddLog(CEC_LOG_DEBUG, logStr.c_str());
459 }
460 if (msg.eom())
461 bReturn = true;
462 break;
463 default:
464 break;
465 }
466
467 return bReturn;
468 }
469
470 void CCECProcessor::ParseVendorId(cec_logical_address device, const cec_datapacket &data)
471 {
472 if (data.size < 3)
473 {
474 m_controller->AddLog(CEC_LOG_WARNING, "invalid vendor ID received");
475 return;
476 }
477
478 uint64_t iVendorId = ((uint64_t)data[0] << 3) +
479 ((uint64_t)data[1] << 2) +
480 (uint64_t)data[2];
481
482 m_vendorIds[(uint8_t)device] = iVendorId;
483 m_vendorClasses[(uint8_t)device] = data.size >= 4 ? data[3] : 0;
484
485 CStdString strLog;
486 strLog.Format("device %d: vendor = %s (%lld) class = %2x", (uint8_t)device, CECVendorIdToString(m_vendorIds[(uint8_t)device]), iVendorId, m_vendorClasses[(uint8_t)device]);
487 m_controller->AddLog(CEC_LOG_DEBUG, strLog.c_str());
488 }
489
490 void CCECProcessor::ParseCommand(cec_command &command)
491 {
492 CStdString dataStr;
493 dataStr.Format(">> received frame: initiator: %u destination: %u", command.initiator, command.destination);
494 if (command.parameters.size > 1)
495 {
496 dataStr += " data:";
497 for (uint8_t iPtr = 0; iPtr < command.parameters.size; iPtr++)
498 dataStr.AppendFormat(" %02x", (unsigned int)command.parameters[iPtr]);
499 }
500 m_controller->AddLog(CEC_LOG_DEBUG, dataStr.c_str());
501
502 if (command.destination == m_iLogicalAddress)
503 {
504 switch(command.opcode)
505 {
506 case CEC_OPCODE_GIVE_PHYSICAL_ADDRESS:
507 ReportPhysicalAddress();
508 break;
509 case CEC_OPCODE_GIVE_OSD_NAME:
510 ReportOSDName(command.initiator);
511 break;
512 case CEC_OPCODE_GIVE_DEVICE_VENDOR_ID:
513 ReportVendorID(command.initiator);
514 break;
515 case CEC_OPCODE_VENDOR_COMMAND_WITH_ID:
516 ParseVendorId(command.initiator, command.parameters);
517 TransmitAbort(command.initiator, CEC_OPCODE_VENDOR_COMMAND_WITH_ID);
518 break;
519 case CEC_OPCODE_GIVE_DECK_STATUS:
520 // need to support opcodes play and deck control before doing anything with this
521 TransmitAbort(command.initiator, CEC_OPCODE_GIVE_DECK_STATUS);
522 break;
523 case CEC_OPCODE_MENU_REQUEST:
524 if (command.parameters[0] == CEC_MENU_REQUEST_TYPE_QUERY)
525 ReportMenuState(command.initiator);
526 break;
527 case CEC_OPCODE_GIVE_DEVICE_POWER_STATUS:
528 ReportPowerState(command.initiator);
529 SetActiveView();
530 break;
531 case CEC_OPCODE_GET_CEC_VERSION:
532 ReportCECVersion(command.initiator);
533 break;
534 case CEC_OPCODE_USER_CONTROL_PRESSED:
535 if (command.parameters.size > 0)
536 {
537 m_controller->AddKey();
538
539 if (command.parameters[0] <= CEC_USER_CONTROL_CODE_MAX)
540 m_controller->SetCurrentButton((cec_user_control_code) command.parameters[0]);
541 }
542 break;
543 case CEC_OPCODE_USER_CONTROL_RELEASE:
544 m_controller->AddKey();
545 break;
546 case CEC_OPCODE_ROUTING_CHANGE:
547 m_controller->SetActiveView();
548 break;
549 default:
550 m_controller->AddCommand(command);
551 break;
552 }
553 }
554 else if (command.destination == CECDEVICE_BROADCAST)
555 {
556 CStdString strLog;
557 if (command.opcode == CEC_OPCODE_REQUEST_ACTIVE_SOURCE)
558 {
559 strLog.Format(">> %i requests active source", (uint8_t) command.initiator);
560 m_controller->AddLog(CEC_LOG_DEBUG, strLog.c_str());
561 BroadcastActiveSource();
562 }
563 else if (command.opcode == CEC_OPCODE_SET_STREAM_PATH)
564 {
565 if (command.parameters.size >= 2)
566 {
567 int streamaddr = ((int)command.parameters[0] << 8) | ((int)command.parameters[1]);
568 strLog.Format(">> %i requests stream path from physical address %04x", command.initiator, streamaddr);
569 m_controller->AddLog(CEC_LOG_DEBUG, strLog.c_str());
570 if (streamaddr == m_physicaladdress)
571 BroadcastActiveSource();
572 }
573 }
574 else
575 {
576 m_controller->AddCommand(command);
577 }
578 }
579 else
580 {
581 CStdString strLog;
582 strLog.Format("ignoring frame: destination: %u != %u", command.destination, (uint8_t)m_iLogicalAddress);
583 m_controller->AddLog(CEC_LOG_DEBUG, strLog.c_str());
584 }
585 }
586
587 const char *CCECProcessor::CECVendorIdToString(const uint64_t iVendorId)
588 {
589 switch (iVendorId)
590 {
591 case CEC_VENDOR_SAMSUNG:
592 return "Samsung";
593 default:
594 return "Unknown";
595 }
596 }