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