Commit | Line | Data |
---|---|---|
abbca718 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 | ||
33 | #include "CECParser.h" | |
34 | ||
35 | #include <algorithm> | |
36 | #include <cstdio> | |
37 | #include <cstdlib> | |
38 | #include <cstring> | |
39 | #include <sys/stat.h> | |
40 | #include "util/StdString.h" | |
41 | #include "libPlatform/serialport.h" | |
42 | #include "util/threads.h" | |
43 | #include "util/timeutils.h" | |
44 | #include "CECDetect.h" | |
a8f0bd18 | 45 | #include "Communication.h" |
abbca718 LOK |
46 | |
47 | using namespace CEC; | |
48 | using namespace std; | |
49 | ||
50 | #define CEC_MAX_RETRY 5 | |
390b42d6 | 51 | #define CEC_BUTTON_TIMEOUT 500 |
abbca718 LOK |
52 | |
53 | /*! | |
54 | * ICECDevice implementation | |
55 | */ | |
56 | //@{ | |
df7339c6 | 57 | CCECParser::CCECParser(const char *strDeviceName, cec_logical_address iLogicalAddress /* = CECDEVICE_PLAYBACKDEVICE1 */, int iPhysicalAddress /* = CEC_DEFAULT_PHYSICAL_ADDRESS*/) : |
abbca718 | 58 | m_iCurrentButton(CEC_USER_CONTROL_CODE_UNKNOWN), |
df7339c6 LOK |
59 | m_physicaladdress(iPhysicalAddress), |
60 | m_iLogicalAddress(iLogicalAddress), | |
abbca718 LOK |
61 | m_strDeviceName(strDeviceName), |
62 | m_bRunning(false) | |
63 | { | |
a8f0bd18 | 64 | m_communication = new CCommunication(this); |
abbca718 LOK |
65 | } |
66 | ||
67 | CCECParser::~CCECParser(void) | |
68 | { | |
f99bc831 | 69 | Close(0); |
a8f0bd18 LOK |
70 | m_communication->Close(); |
71 | delete m_communication; | |
abbca718 LOK |
72 | } |
73 | ||
74 | bool CCECParser::Open(const char *strPort, int iTimeoutMs /* = 10000 */) | |
75 | { | |
a8f0bd18 LOK |
76 | if (!m_communication) |
77 | return false; | |
abbca718 | 78 | |
a8f0bd18 | 79 | if (m_communication->IsOpen()) |
abbca718 | 80 | { |
a8f0bd18 LOK |
81 | AddLog(CEC_LOG_ERROR, "connection already open"); |
82 | return false; | |
abbca718 LOK |
83 | } |
84 | ||
a8f0bd18 LOK |
85 | if (!m_communication->Open(strPort, 38400, iTimeoutMs)) |
86 | { | |
87 | AddLog(CEC_LOG_ERROR, "could not open a connection"); | |
88 | return false; | |
89 | } | |
abbca718 | 90 | |
a8f0bd18 | 91 | if (!SetLogicalAddress(m_iLogicalAddress)) |
abbca718 | 92 | { |
a8f0bd18 LOK |
93 | AddLog(CEC_LOG_ERROR, "could not set the logical address"); |
94 | return false; | |
abbca718 LOK |
95 | } |
96 | ||
a8f0bd18 | 97 | if (pthread_create(&m_thread, NULL, (void *(*) (void *))&CCECParser::ThreadHandler, (void *)this) == 0) |
abbca718 LOK |
98 | { |
99 | m_bRunning = true; | |
a8f0bd18 LOK |
100 | AddLog(CEC_LOG_DEBUG, "processor thread created"); |
101 | pthread_detach(m_thread); | |
102 | return true; | |
103 | } | |
104 | else | |
105 | { | |
106 | AddLog(CEC_LOG_ERROR, "could not create a processor thread"); | |
107 | m_bRunning = false; | |
abbca718 LOK |
108 | } |
109 | ||
a8f0bd18 | 110 | return false; |
abbca718 LOK |
111 | } |
112 | ||
f99bc831 LOK |
113 | bool CCECParser::Close(int iTimeoutMs /* = 2000 */) |
114 | { | |
115 | m_bRunning = false; | |
116 | bool bExit(false); | |
117 | if (iTimeoutMs > 0) | |
118 | { | |
119 | bExit = m_exitCondition.Wait(&m_mutex, iTimeoutMs); | |
120 | m_mutex.Unlock(); | |
121 | } | |
122 | else | |
123 | { | |
124 | pthread_join(m_thread, NULL); | |
125 | bExit = true; | |
126 | } | |
127 | ||
128 | return bExit; | |
129 | } | |
130 | ||
abbca718 LOK |
131 | void *CCECParser::ThreadHandler(CCECParser *parser) |
132 | { | |
133 | if (parser) | |
134 | parser->Process(); | |
135 | return 0; | |
136 | } | |
137 | ||
138 | bool CCECParser::Process(void) | |
139 | { | |
140 | int64_t now = GetTimeMs(); | |
141 | while (m_bRunning) | |
142 | { | |
a8f0bd18 | 143 | cec_frame msg; |
390b42d6 | 144 | while (m_bRunning && m_communication->IsOpen() && m_communication->Read(msg, CEC_BUTTON_TIMEOUT)) |
a8f0bd18 | 145 | ParseMessage(msg); |
abbca718 | 146 | |
abbca718 LOK |
147 | now = GetTimeMs(); |
148 | CheckKeypressTimeout(now); | |
149 | CCondition::Sleep(50); | |
150 | } | |
151 | ||
a8f0bd18 | 152 | AddLog(CEC_LOG_DEBUG, "processor thread terminated"); |
abbca718 | 153 | m_bRunning = false; |
f99bc831 | 154 | m_exitCondition.Signal(); |
abbca718 LOK |
155 | return true; |
156 | } | |
157 | ||
158 | bool CCECParser::Ping(void) | |
159 | { | |
f99bc831 LOK |
160 | if (!m_bRunning) |
161 | return false; | |
162 | ||
abbca718 LOK |
163 | AddLog(CEC_LOG_DEBUG, "sending ping"); |
164 | cec_frame output; | |
165 | output.push_back(MSGSTART); | |
166 | PushEscaped(output, MSGCODE_PING); | |
167 | output.push_back(MSGEND); | |
168 | ||
390b42d6 | 169 | if (!TransmitFormatted(output, false)) |
abbca718 LOK |
170 | { |
171 | AddLog(CEC_LOG_ERROR, "could not send ping command"); | |
172 | return false; | |
173 | } | |
174 | ||
175 | AddLog(CEC_LOG_DEBUG, "ping tranmitted"); | |
176 | ||
177 | // TODO check for pong | |
178 | return true; | |
179 | } | |
180 | ||
181 | bool CCECParser::StartBootloader(void) | |
182 | { | |
f99bc831 LOK |
183 | if (!m_bRunning) |
184 | return false; | |
185 | ||
abbca718 LOK |
186 | AddLog(CEC_LOG_DEBUG, "starting the bootloader"); |
187 | cec_frame output; | |
188 | output.push_back(MSGSTART); | |
189 | PushEscaped(output, MSGCODE_START_BOOTLOADER); | |
190 | output.push_back(MSGEND); | |
191 | ||
390b42d6 | 192 | if (!TransmitFormatted(output, false)) |
abbca718 LOK |
193 | { |
194 | AddLog(CEC_LOG_ERROR, "could not start the bootloader"); | |
195 | return false; | |
196 | } | |
197 | ||
198 | AddLog(CEC_LOG_DEBUG, "bootloader start command transmitted"); | |
199 | return true; | |
200 | } | |
201 | ||
202 | uint8_t CCECParser::GetSourceDestination(cec_logical_address destination /* = CECDEVICE_BROADCAST */) | |
203 | { | |
204 | return ((uint8_t)m_iLogicalAddress << 4) + (uint8_t)destination; | |
205 | } | |
206 | ||
207 | bool CCECParser::PowerOffDevices(cec_logical_address address /* = CECDEVICE_BROADCAST */) | |
208 | { | |
8148859e | 209 | return StandbyDevices(address); |
abbca718 LOK |
210 | } |
211 | ||
8148859e | 212 | bool CCECParser::PowerOnDevices(cec_logical_address address /* = CECDEVICE_TV */) |
abbca718 | 213 | { |
f99bc831 LOK |
214 | if (!m_bRunning) |
215 | return false; | |
216 | ||
abbca718 LOK |
217 | CStdString strLog; |
218 | strLog.Format("powering on devices with logical address %d", (int8_t)address); | |
219 | AddLog(CEC_LOG_DEBUG, strLog.c_str()); | |
220 | cec_frame frame; | |
221 | frame.push_back(GetSourceDestination(address)); | |
222 | frame.push_back(CEC_OPCODE_TEXT_VIEW_ON); | |
223 | return Transmit(frame); | |
224 | } | |
225 | ||
226 | bool CCECParser::StandbyDevices(cec_logical_address address /* = CECDEVICE_BROADCAST */) | |
227 | { | |
f99bc831 LOK |
228 | if (!m_bRunning) |
229 | return false; | |
230 | ||
abbca718 LOK |
231 | CStdString strLog; |
232 | strLog.Format("putting all devices with logical address %d in standby mode", (int8_t)address); | |
233 | AddLog(CEC_LOG_DEBUG, strLog.c_str()); | |
234 | cec_frame frame; | |
235 | frame.push_back(GetSourceDestination(address)); | |
236 | frame.push_back(CEC_OPCODE_STANDBY); | |
237 | return Transmit(frame); | |
238 | } | |
239 | ||
240 | bool CCECParser::SetActiveView(void) | |
241 | { | |
f99bc831 LOK |
242 | if (!m_bRunning) |
243 | return false; | |
244 | ||
abbca718 LOK |
245 | AddLog(CEC_LOG_DEBUG, "setting active view"); |
246 | cec_frame frame; | |
247 | frame.push_back(GetSourceDestination(CECDEVICE_BROADCAST)); | |
248 | frame.push_back(CEC_OPCODE_ACTIVE_SOURCE); | |
249 | frame.push_back((m_physicaladdress >> 8) & 0xFF); | |
250 | frame.push_back(m_physicaladdress & 0xFF); | |
251 | return Transmit(frame); | |
252 | } | |
253 | ||
254 | bool CCECParser::SetInactiveView(void) | |
255 | { | |
f99bc831 LOK |
256 | if (!m_bRunning) |
257 | return false; | |
258 | ||
abbca718 LOK |
259 | AddLog(CEC_LOG_DEBUG, "setting inactive view"); |
260 | cec_frame frame; | |
261 | frame.push_back(GetSourceDestination(CECDEVICE_BROADCAST)); | |
262 | frame.push_back(CEC_OPCODE_INACTIVE_SOURCE); | |
263 | frame.push_back((m_physicaladdress >> 8) & 0xFF); | |
264 | frame.push_back(m_physicaladdress & 0xFF); | |
265 | return Transmit(frame); | |
266 | } | |
267 | ||
268 | bool CCECParser::GetNextLogMessage(cec_log_message *message) | |
269 | { | |
a8f0bd18 | 270 | return m_logBuffer.Pop(*message); |
abbca718 LOK |
271 | } |
272 | ||
273 | bool CCECParser::GetNextKeypress(cec_keypress *key) | |
274 | { | |
f99bc831 | 275 | return m_bRunning ? m_keyBuffer.Pop(*key) : false; |
abbca718 | 276 | } |
825ddb96 LOK |
277 | |
278 | bool CCECParser::GetNextCommand(cec_command *command) | |
279 | { | |
f99bc831 | 280 | return m_bRunning ? m_commandBuffer.Pop(*command) : false; |
825ddb96 | 281 | } |
abbca718 LOK |
282 | //@} |
283 | ||
825ddb96 | 284 | void CCECParser::TransmitAbort(cec_logical_address address, cec_opcode opcode, ECecAbortReason reason /* = CEC_ABORT_REASON_UNRECOGNIZED_OPCODE */) |
abbca718 LOK |
285 | { |
286 | AddLog(CEC_LOG_DEBUG, "transmitting abort message"); | |
287 | cec_frame frame; | |
288 | frame.push_back(GetSourceDestination(address)); | |
289 | frame.push_back(CEC_OPCODE_FEATURE_ABORT); | |
290 | frame.push_back(opcode); | |
291 | frame.push_back(reason); | |
292 | Transmit(frame); | |
293 | } | |
294 | ||
295 | void CCECParser::ReportCECVersion(cec_logical_address address /* = CECDEVICE_TV */) | |
296 | { | |
297 | cec_frame frame; | |
298 | AddLog(CEC_LOG_NOTICE, "reporting CEC version as 1.3a"); | |
299 | frame.push_back(GetSourceDestination(address)); | |
300 | frame.push_back(CEC_OPCODE_CEC_VERSION); | |
301 | frame.push_back(CEC_VERSION_1_3A); | |
302 | Transmit(frame); | |
303 | } | |
304 | ||
305 | void CCECParser::ReportPowerState(cec_logical_address address /*= CECDEVICE_TV */, bool bOn /* = true */) | |
306 | { | |
307 | cec_frame frame; | |
308 | if (bOn) | |
309 | AddLog(CEC_LOG_NOTICE, "reporting \"On\" power status"); | |
310 | else | |
311 | AddLog(CEC_LOG_NOTICE, "reporting \"Off\" power status"); | |
312 | ||
313 | frame.push_back(GetSourceDestination(address)); | |
314 | frame.push_back(CEC_OPCODE_REPORT_POWER_STATUS); | |
315 | frame.push_back(bOn ? CEC_POWER_STATUS_ON : CEC_POWER_STATUS_STANDBY); | |
316 | Transmit(frame); | |
317 | } | |
318 | ||
319 | void CCECParser::ReportMenuState(cec_logical_address address /* = CECDEVICE_TV */, bool bActive /* = true */) | |
320 | { | |
321 | cec_frame frame; | |
322 | if (bActive) | |
323 | AddLog(CEC_LOG_NOTICE, "reporting menu state as active"); | |
324 | else | |
325 | AddLog(CEC_LOG_NOTICE, "reporting menu state as inactive"); | |
326 | ||
327 | frame.push_back(GetSourceDestination(address)); | |
328 | frame.push_back(CEC_OPCODE_MENU_STATUS); | |
329 | frame.push_back(bActive ? CEC_MENU_STATE_ACTIVATED : CEC_MENU_STATE_DEACTIVATED); | |
330 | Transmit(frame); | |
331 | } | |
332 | ||
333 | void CCECParser::ReportVendorID(cec_logical_address address /* = CECDEVICE_TV */) | |
334 | { | |
335 | AddLog(CEC_LOG_NOTICE, "vendor ID requested, feature abort"); | |
336 | TransmitAbort(address, CEC_OPCODE_GIVE_DEVICE_VENDOR_ID); | |
337 | } | |
338 | ||
339 | void CCECParser::ReportOSDName(cec_logical_address address /* = CECDEVICE_TV */) | |
340 | { | |
341 | cec_frame frame; | |
342 | const char *osdname = m_strDeviceName.c_str(); | |
343 | CStdString strLog; | |
344 | strLog.Format("reporting OSD name as %s", osdname); | |
345 | AddLog(CEC_LOG_NOTICE, strLog.c_str()); | |
346 | frame.push_back(GetSourceDestination(address)); | |
347 | frame.push_back(CEC_OPCODE_SET_OSD_NAME); | |
348 | ||
349 | for (unsigned int i = 0; i < strlen(osdname); i++) | |
350 | frame.push_back(osdname[i]); | |
351 | ||
352 | Transmit(frame); | |
353 | } | |
354 | ||
355 | void CCECParser::ReportPhysicalAddress(void) | |
356 | { | |
357 | cec_frame frame; | |
358 | CStdString strLog; | |
359 | strLog.Format("reporting physical address as %04x", m_physicaladdress); | |
360 | AddLog(CEC_LOG_NOTICE, strLog.c_str()); | |
361 | frame.push_back(GetSourceDestination(CECDEVICE_BROADCAST)); | |
362 | frame.push_back(CEC_OPCODE_REPORT_PHYSICAL_ADDRESS); | |
363 | frame.push_back((m_physicaladdress >> 8) & 0xFF); | |
364 | frame.push_back(m_physicaladdress & 0xFF); | |
365 | frame.push_back(CEC_DEVICE_TYPE_PLAYBACK_DEVICE); | |
366 | Transmit(frame); | |
367 | } | |
368 | ||
369 | void CCECParser::BroadcastActiveSource(void) | |
370 | { | |
371 | cec_frame frame; | |
372 | AddLog(CEC_LOG_NOTICE, "broadcasting active source"); | |
373 | frame.push_back(GetSourceDestination(CECDEVICE_BROADCAST)); | |
374 | frame.push_back(CEC_OPCODE_ACTIVE_SOURCE); | |
375 | frame.push_back((m_physicaladdress >> 8) & 0xFF); | |
376 | frame.push_back(m_physicaladdress & 0xFF); | |
377 | Transmit(frame); | |
378 | } | |
379 | ||
390b42d6 | 380 | bool CCECParser::TransmitFormatted(const cec_frame &data, bool bWaitForAck /* = true */) |
abbca718 | 381 | { |
3fcd38dc | 382 | if (!m_communication || !m_communication->Write(data)) |
abbca718 | 383 | return false; |
abbca718 LOK |
384 | |
385 | CCondition::Sleep((int) data.size() * 24 /*data*/ + 5 /*start bit (4.5 ms)*/ + 50 /* to be on the safe side */); | |
386 | if (bWaitForAck && !WaitForAck()) | |
387 | { | |
388 | AddLog(CEC_LOG_DEBUG, "did not receive ACK"); | |
389 | return false; | |
390 | } | |
391 | ||
392 | return true; | |
393 | } | |
394 | ||
390b42d6 | 395 | bool CCECParser::Transmit(const cec_frame &data, bool bWaitForAck /* = true */) |
abbca718 LOK |
396 | { |
397 | CStdString txStr = "transmit "; | |
398 | for (unsigned int i = 0; i < data.size(); i++) | |
399 | txStr.AppendFormat(" %02x", data[i]); | |
400 | AddLog(CEC_LOG_DEBUG, txStr.c_str()); | |
401 | ||
402 | if (data.empty()) | |
403 | { | |
404 | AddLog(CEC_LOG_WARNING, "transmit buffer is empty"); | |
405 | return false; | |
406 | } | |
407 | ||
408 | cec_frame output; | |
409 | ||
410 | //set ack polarity to high when transmitting to the broadcast address | |
411 | //set ack polarity low when transmitting to any other address | |
412 | output.push_back(MSGSTART); | |
413 | PushEscaped(output, MSGCODE_TRANSMIT_ACK_POLARITY); | |
414 | ||
415 | if ((data[0] & 0xF) == 0xF) | |
416 | PushEscaped(output, CEC_TRUE); | |
417 | else | |
418 | PushEscaped(output, CEC_FALSE); | |
419 | ||
420 | output.push_back(MSGEND); | |
421 | ||
422 | for (unsigned int i = 0; i < data.size(); i++) | |
423 | { | |
424 | output.push_back(MSGSTART); | |
425 | ||
426 | if (i == data.size() - 1) | |
427 | PushEscaped(output, MSGCODE_TRANSMIT_EOM); | |
428 | else | |
429 | PushEscaped(output, MSGCODE_TRANSMIT); | |
430 | ||
431 | PushEscaped(output, data[i]); | |
432 | ||
433 | output.push_back(MSGEND); | |
434 | } | |
435 | ||
390b42d6 | 436 | return TransmitFormatted(output, bWaitForAck); |
abbca718 LOK |
437 | } |
438 | ||
390b42d6 | 439 | bool CCECParser::WaitForAck(int iTimeout /* = 1000 */) |
abbca718 LOK |
440 | { |
441 | bool bGotAck(false); | |
442 | bool bError(false); | |
443 | ||
444 | int64_t iNow = GetTimeMs(); | |
390b42d6 | 445 | int64_t iTargetTime = iNow + (int64_t) iTimeout; |
abbca718 LOK |
446 | |
447 | while (!bGotAck && !bError && (iTimeout <= 0 || iNow < iTargetTime)) | |
448 | { | |
abbca718 | 449 | cec_frame msg; |
a8f0bd18 | 450 | while (!bGotAck && !bError && m_communication->Read(msg, iTimeout)) |
abbca718 LOK |
451 | { |
452 | uint8_t iCode = msg[0] & ~(MSGCODE_FRAME_EOM | MSGCODE_FRAME_ACK); | |
453 | ||
454 | switch (iCode) | |
455 | { | |
456 | case MSGCODE_COMMAND_ACCEPTED: | |
457 | AddLog(CEC_LOG_DEBUG, "MSGCODE_COMMAND_ACCEPTED"); | |
458 | break; | |
459 | case MSGCODE_TRANSMIT_SUCCEEDED: | |
460 | AddLog(CEC_LOG_DEBUG, "MSGCODE_TRANSMIT_SUCCEEDED"); | |
461 | // TODO | |
462 | bGotAck = true; | |
463 | break; | |
464 | case MSGCODE_RECEIVE_FAILED: | |
465 | AddLog(CEC_LOG_WARNING, "MSGCODE_RECEIVE_FAILED"); | |
466 | bError = true; | |
467 | break; | |
468 | case MSGCODE_COMMAND_REJECTED: | |
469 | AddLog(CEC_LOG_WARNING, "MSGCODE_COMMAND_REJECTED"); | |
470 | bError = true; | |
471 | break; | |
472 | case MSGCODE_TRANSMIT_FAILED_LINE: | |
473 | AddLog(CEC_LOG_WARNING, "MSGCODE_TRANSMIT_FAILED_LINE"); | |
474 | bError = true; | |
475 | break; | |
476 | case MSGCODE_TRANSMIT_FAILED_ACK: | |
477 | AddLog(CEC_LOG_WARNING, "MSGCODE_TRANSMIT_FAILED_ACK"); | |
478 | bError = true; | |
479 | break; | |
480 | case MSGCODE_TRANSMIT_FAILED_TIMEOUT_DATA: | |
481 | AddLog(CEC_LOG_WARNING, "MSGCODE_TRANSMIT_FAILED_TIMEOUT_DATA"); | |
482 | bError = true; | |
483 | break; | |
484 | case MSGCODE_TRANSMIT_FAILED_TIMEOUT_LINE: | |
485 | AddLog(CEC_LOG_WARNING, "MSGCODE_TRANSMIT_FAILED_TIMEOUT_LINE"); | |
486 | bError = true; | |
487 | break; | |
488 | default: | |
489 | m_frameBuffer.Push(msg); | |
490 | bGotAck = (msg[0] & MSGCODE_FRAME_ACK) != 0; | |
491 | break; | |
492 | } | |
493 | iNow = GetTimeMs(); | |
494 | } | |
495 | } | |
496 | ||
497 | return bGotAck && !bError; | |
498 | } | |
499 | ||
abbca718 LOK |
500 | void CCECParser::ParseMessage(cec_frame &msg) |
501 | { | |
502 | if (msg.empty()) | |
503 | return; | |
504 | ||
505 | CStdString logStr; | |
506 | uint8_t iCode = msg[0] & ~(MSGCODE_FRAME_EOM | MSGCODE_FRAME_ACK); | |
507 | bool bEom = (msg[0] & MSGCODE_FRAME_EOM) != 0; | |
508 | bool bAck = (msg[0] & MSGCODE_FRAME_ACK) != 0; | |
509 | ||
510 | switch(iCode) | |
511 | { | |
512 | case MSGCODE_NOTHING: | |
513 | AddLog(CEC_LOG_DEBUG, "MSGCODE_NOTHING"); | |
514 | break; | |
515 | case MSGCODE_TIMEOUT_ERROR: | |
516 | case MSGCODE_HIGH_ERROR: | |
517 | case MSGCODE_LOW_ERROR: | |
518 | { | |
519 | if (iCode == MSGCODE_TIMEOUT_ERROR) | |
520 | logStr = "MSGCODE_TIMEOUT"; | |
521 | else if (iCode == MSGCODE_HIGH_ERROR) | |
522 | logStr = "MSGCODE_HIGH_ERROR"; | |
523 | else | |
524 | logStr = "MSGCODE_LOW_ERROR"; | |
525 | ||
526 | int iLine = (msg.size() >= 3) ? (msg[1] << 8) | (msg[2]) : 0; | |
527 | uint32_t iTime = (msg.size() >= 7) ? (msg[3] << 24) | (msg[4] << 16) | (msg[5] << 8) | (msg[6]) : 0; | |
528 | logStr.AppendFormat(" line:%i", iLine); | |
529 | logStr.AppendFormat(" time:%u", iTime); | |
530 | AddLog(CEC_LOG_WARNING, logStr.c_str()); | |
531 | } | |
532 | break; | |
533 | case MSGCODE_FRAME_START: | |
534 | { | |
535 | logStr = "MSGCODE_FRAME_START"; | |
536 | m_currentframe.clear(); | |
537 | if (msg.size() >= 2) | |
538 | { | |
539 | int iInitiator = msg[1] >> 4; | |
540 | int iDestination = msg[1] & 0xF; | |
541 | logStr.AppendFormat(" initiator:%u destination:%u ack:%s %s", iInitiator, iDestination, bAck ? "high" : "low", bEom ? "eom" : ""); | |
542 | ||
543 | m_currentframe.push_back(msg[1]); | |
544 | } | |
545 | AddLog(CEC_LOG_DEBUG, logStr.c_str()); | |
546 | } | |
547 | break; | |
548 | case MSGCODE_FRAME_DATA: | |
549 | { | |
550 | logStr = "MSGCODE_FRAME_DATA"; | |
551 | if (msg.size() >= 2) | |
552 | { | |
553 | uint8_t iData = msg[1]; | |
554 | logStr.AppendFormat(" %02x", iData); | |
555 | m_currentframe.push_back(iData); | |
556 | } | |
557 | AddLog(CEC_LOG_DEBUG, logStr.c_str()); | |
558 | } | |
559 | if (bEom) | |
560 | ParseCurrentFrame(); | |
561 | break; | |
562 | default: | |
563 | break; | |
564 | } | |
565 | } | |
566 | ||
567 | void CCECParser::ParseCurrentFrame(void) | |
568 | { | |
569 | uint8_t initiator = m_currentframe[0] >> 4; | |
570 | uint8_t destination = m_currentframe[0] & 0xF; | |
571 | ||
572 | CStdString dataStr; | |
573 | dataStr.Format("received frame: initiator: %u destination: %u", initiator, destination); | |
574 | ||
575 | if (m_currentframe.size() > 1) | |
576 | { | |
577 | dataStr += " data:"; | |
578 | for (unsigned int i = 1; i < m_currentframe.size(); i++) | |
579 | dataStr.AppendFormat(" %02x", m_currentframe[i]); | |
580 | } | |
581 | AddLog(CEC_LOG_DEBUG, dataStr.c_str()); | |
582 | ||
583 | if (m_currentframe.size() <= 1) | |
584 | return; | |
585 | ||
586 | vector<uint8_t> tx; | |
825ddb96 | 587 | cec_opcode opCode = (cec_opcode) m_currentframe[1]; |
abbca718 LOK |
588 | if (destination == (uint16_t) m_iLogicalAddress) |
589 | { | |
590 | switch(opCode) | |
591 | { | |
592 | case CEC_OPCODE_GIVE_PHYSICAL_ADDRESS: | |
593 | ReportPhysicalAddress(); | |
594 | SetActiveView(); | |
595 | break; | |
596 | case CEC_OPCODE_GIVE_OSD_NAME: | |
597 | ReportOSDName((cec_logical_address)initiator); | |
598 | break; | |
599 | case CEC_OPCODE_GIVE_DEVICE_VENDOR_ID: | |
600 | ReportVendorID((cec_logical_address)initiator); | |
601 | break; | |
602 | case CEC_OPCODE_MENU_REQUEST: | |
603 | ReportMenuState((cec_logical_address)initiator); | |
604 | break; | |
605 | case CEC_OPCODE_GIVE_DEVICE_POWER_STATUS: | |
606 | ReportPowerState((cec_logical_address)initiator); | |
607 | break; | |
608 | case CEC_OPCODE_GET_CEC_VERSION: | |
609 | ReportCECVersion((cec_logical_address)initiator); | |
610 | break; | |
611 | case CEC_OPCODE_USER_CONTROL_PRESSED: | |
612 | if (m_currentframe.size() > 2) | |
613 | { | |
614 | AddKey(); | |
615 | ||
616 | if (m_currentframe[2] <= CEC_USER_CONTROL_CODE_MAX) | |
617 | { | |
618 | m_iCurrentButton = (cec_user_control_code) m_currentframe[2]; | |
619 | m_buttontime = GetTimeMs(); | |
620 | } | |
621 | } | |
622 | break; | |
623 | case CEC_OPCODE_USER_CONTROL_RELEASE: | |
624 | AddKey(); | |
625 | break; | |
626 | default: | |
825ddb96 LOK |
627 | cec_frame params = m_currentframe; |
628 | params.erase(params.begin(), params.begin() + 2); | |
629 | AddCommand((cec_logical_address) initiator, (cec_logical_address) destination, opCode, ¶ms); | |
abbca718 LOK |
630 | break; |
631 | } | |
632 | } | |
633 | else if (destination == (uint8_t) CECDEVICE_BROADCAST) | |
634 | { | |
635 | if (opCode == CEC_OPCODE_REQUEST_ACTIVE_SOURCE) | |
636 | { | |
637 | BroadcastActiveSource(); | |
638 | } | |
639 | else if (opCode == CEC_OPCODE_SET_STREAM_PATH) | |
640 | { | |
641 | if (m_currentframe.size() >= 4) | |
642 | { | |
643 | int streamaddr = ((int)m_currentframe[2] << 8) | ((int)m_currentframe[3]); | |
644 | CStdString strLog; | |
645 | strLog.Format("%i requests stream path from physical address %04x", initiator, streamaddr); | |
646 | AddLog(CEC_LOG_DEBUG, strLog.c_str()); | |
647 | if (streamaddr == m_physicaladdress) | |
648 | BroadcastActiveSource(); | |
649 | } | |
650 | } | |
c49c485b LOK |
651 | else |
652 | { | |
653 | cec_frame params = m_currentframe; | |
654 | params.erase(params.begin(), params.begin() + 2); | |
655 | AddCommand((cec_logical_address) initiator, (cec_logical_address) destination, opCode, ¶ms); | |
656 | } | |
abbca718 LOK |
657 | } |
658 | else | |
659 | { | |
660 | CStdString strLog; | |
661 | strLog.Format("ignoring frame: destination: %u != %u", destination, (uint16_t)m_iLogicalAddress); | |
662 | AddLog(CEC_LOG_DEBUG, strLog.c_str()); | |
663 | } | |
664 | } | |
665 | ||
abbca718 LOK |
666 | void CCECParser::PushEscaped(cec_frame &vec, uint8_t byte) |
667 | { | |
668 | if (byte >= MSGESC && byte != MSGSTART) | |
669 | { | |
670 | vec.push_back(MSGESC); | |
671 | vec.push_back(byte - ESCOFFSET); | |
672 | } | |
673 | else | |
674 | { | |
675 | vec.push_back(byte); | |
676 | } | |
677 | } | |
678 | ||
679 | void CCECParser::CheckKeypressTimeout(int64_t now) | |
680 | { | |
390b42d6 | 681 | if (m_iCurrentButton != CEC_USER_CONTROL_CODE_UNKNOWN && now - m_buttontime > CEC_BUTTON_TIMEOUT) |
abbca718 LOK |
682 | { |
683 | AddKey(); | |
684 | m_iCurrentButton = CEC_USER_CONTROL_CODE_UNKNOWN; | |
685 | } | |
686 | } | |
687 | ||
6dfe9213 | 688 | bool CCECParser::SetLogicalAddress(cec_logical_address iLogicalAddress) |
abbca718 LOK |
689 | { |
690 | CStdString strLog; | |
6dfe9213 | 691 | strLog.Format("setting logical address to %d", iLogicalAddress); |
abbca718 LOK |
692 | AddLog(CEC_LOG_NOTICE, strLog.c_str()); |
693 | ||
6dfe9213 LOK |
694 | m_iLogicalAddress = iLogicalAddress; |
695 | return SetAckMask(0x1 << (uint8_t)m_iLogicalAddress); | |
696 | } | |
697 | ||
698 | bool CCECParser::SetAckMask(uint16_t iMask) | |
699 | { | |
700 | CStdString strLog; | |
701 | strLog.Format("setting ackmask to %2x", iMask); | |
702 | AddLog(CEC_LOG_DEBUG, strLog.c_str()); | |
703 | ||
abbca718 | 704 | cec_frame output; |
abbca718 | 705 | |
6dfe9213 | 706 | output.push_back(MSGSTART); |
abbca718 | 707 | PushEscaped(output, MSGCODE_SET_ACK_MASK); |
6dfe9213 | 708 | PushEscaped(output, iMask >> 8); |
bcd03b37 | 709 | PushEscaped(output, (uint8_t)iMask); |
abbca718 LOK |
710 | output.push_back(MSGEND); |
711 | ||
3fcd38dc | 712 | if (!m_communication->Write(output)) |
abbca718 | 713 | { |
a8f0bd18 | 714 | AddLog(CEC_LOG_ERROR, "could not set the ackmask"); |
abbca718 LOK |
715 | return false; |
716 | } | |
717 | ||
718 | return true; | |
719 | } | |
720 | ||
721 | void CCECParser::AddLog(cec_log_level level, const string &strMessage) | |
722 | { | |
723 | cec_log_message message; | |
724 | message.level = level; | |
725 | message.message.assign(strMessage.c_str()); | |
726 | m_logBuffer.Push(message); | |
727 | } | |
728 | ||
729 | void CCECParser::AddKey(void) | |
730 | { | |
731 | if (m_iCurrentButton != CEC_USER_CONTROL_CODE_UNKNOWN) | |
732 | { | |
733 | cec_keypress key; | |
734 | key.duration = (unsigned int) (GetTimeMs() - m_buttontime); | |
735 | key.keycode = m_iCurrentButton; | |
736 | m_keyBuffer.Push(key); | |
737 | m_iCurrentButton = CEC_USER_CONTROL_CODE_UNKNOWN; | |
738 | m_buttontime = 0; | |
739 | } | |
740 | } | |
741 | ||
825ddb96 LOK |
742 | void CCECParser::AddCommand(cec_logical_address source, cec_logical_address destination, cec_opcode opcode, cec_frame *parameters) |
743 | { | |
744 | cec_command command; | |
745 | command.source = source; | |
746 | command.destination = destination; | |
747 | command.opcode = opcode; | |
748 | if (parameters) | |
749 | command.parameters = *parameters; | |
c49c485b LOK |
750 | if (m_commandBuffer.Push(command)) |
751 | { | |
752 | CStdString strDebug; | |
753 | strDebug.Format("stored command '%d' in the command buffer. buffer size = %d", opcode, m_commandBuffer.Size()); | |
754 | AddLog(CEC_LOG_DEBUG, strDebug); | |
755 | } | |
756 | else | |
757 | { | |
758 | AddLog(CEC_LOG_WARNING, "command buffer is full"); | |
759 | } | |
825ddb96 LOK |
760 | } |
761 | ||
abbca718 LOK |
762 | int CCECParser::GetMinVersion(void) |
763 | { | |
764 | return CEC_MIN_VERSION; | |
765 | } | |
766 | ||
767 | int CCECParser::GetLibVersion(void) | |
768 | { | |
769 | return CEC_LIB_VERSION; | |
770 | } | |
771 | ||
772 | int CCECParser::FindDevices(std::vector<cec_device> &deviceList, const char *strDevicePath /* = NULL */) | |
773 | { | |
774 | CStdString strDebug; | |
775 | if (strDevicePath) | |
776 | strDebug.Format("trying to autodetect the com port for device path '%s'", strDevicePath); | |
777 | else | |
778 | strDebug.Format("trying to autodetect all CEC adapters"); | |
779 | AddLog(CEC_LOG_DEBUG, strDebug); | |
780 | ||
781 | return CCECDetect::FindDevices(deviceList, strDevicePath); | |
782 | } | |
783 | ||
bcd03b37 | 784 | DECLSPEC void * CECCreate(const char *strDeviceName, CEC::cec_logical_address iLogicalAddress /*= CEC::CECDEVICE_PLAYBACKDEVICE1 */, int iPhysicalAddress /* = CEC_DEFAULT_PHYSICAL_ADDRESS */) |
abbca718 | 785 | { |
df7339c6 | 786 | return static_cast< void* > (new CCECParser(strDeviceName, iLogicalAddress, iPhysicalAddress)); |
abbca718 | 787 | } |