Commit | Line | Data |
---|---|---|
a75e3a5a LOK |
1 | /* |
2 | * This file is part of the libCEC(R) library. | |
3 | * | |
4 | * libCEC(R) is Copyright (C) 2011-2012 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 | ||
2b44051c | 33 | #include "env.h" |
a75e3a5a | 34 | #include "USBCECAdapterMessage.h" |
2b44051c LOK |
35 | |
36 | #include "lib/LibCEC.h" | |
37 | #include "lib/platform/util/StdString.h" | |
a75e3a5a LOK |
38 | |
39 | using namespace CEC; | |
40 | using namespace PLATFORM; | |
41 | ||
42 | CCECAdapterMessage::CCECAdapterMessage(void) | |
43 | { | |
44 | Clear(); | |
45 | } | |
46 | ||
33dd87a9 | 47 | CCECAdapterMessage::CCECAdapterMessage(const cec_command &command, uint8_t iLineTimeout /* = 3 */) |
a75e3a5a LOK |
48 | { |
49 | Clear(); | |
50 | ||
51 | //set ack polarity to high when transmitting to the broadcast address | |
52 | //set ack polarity low when transmitting to any other address | |
53 | PushBack(MSGSTART); | |
54 | PushEscaped(MSGCODE_TRANSMIT_ACK_POLARITY); | |
55 | if (command.destination == CECDEVICE_BROADCAST) | |
56 | PushEscaped(CEC_TRUE); | |
57 | else | |
58 | PushEscaped(CEC_FALSE); | |
59 | PushBack(MSGEND); | |
60 | ||
61 | // add source and destination | |
62 | PushBack(MSGSTART); | |
63 | PushEscaped(command.opcode_set == 0 ? (uint8_t)MSGCODE_TRANSMIT_EOM : (uint8_t)MSGCODE_TRANSMIT); | |
64 | PushBack(((uint8_t)command.initiator << 4) + (uint8_t)command.destination); | |
65 | PushBack(MSGEND); | |
66 | ||
67 | // add opcode | |
68 | if (command.opcode_set == 1) | |
69 | { | |
70 | PushBack(MSGSTART); | |
71 | PushEscaped(command.parameters.IsEmpty() ? (uint8_t)MSGCODE_TRANSMIT_EOM : (uint8_t)MSGCODE_TRANSMIT); | |
72 | PushBack((uint8_t) command.opcode); | |
73 | PushBack(MSGEND); | |
74 | ||
75 | // add parameters | |
76 | for (int8_t iPtr = 0; iPtr < command.parameters.size; iPtr++) | |
77 | { | |
78 | PushBack(MSGSTART); | |
79 | ||
80 | if (iPtr == command.parameters.size - 1) | |
81 | PushEscaped( MSGCODE_TRANSMIT_EOM); | |
82 | else | |
83 | PushEscaped(MSGCODE_TRANSMIT); | |
84 | ||
85 | PushEscaped(command.parameters[iPtr]); | |
86 | ||
87 | PushBack(MSGEND); | |
88 | } | |
89 | } | |
90 | ||
91 | // set timeout | |
92 | transmit_timeout = command.transmit_timeout; | |
93 | ||
a75e3a5a | 94 | lineTimeout = iLineTimeout; |
a75e3a5a LOK |
95 | } |
96 | ||
2b44051c | 97 | std::string CCECAdapterMessage::ToString(void) const |
a75e3a5a LOK |
98 | { |
99 | CStdString strMsg; | |
100 | if (Size() == 0) | |
101 | { | |
102 | strMsg = "empty message"; | |
103 | } | |
104 | else | |
105 | { | |
106 | strMsg = ToString(Message()); | |
107 | ||
108 | switch (Message()) | |
109 | { | |
110 | case MSGCODE_TIMEOUT_ERROR: | |
111 | case MSGCODE_HIGH_ERROR: | |
112 | case MSGCODE_LOW_ERROR: | |
113 | { | |
114 | uint32_t iLine = (Size() >= 4) ? (At(2) << 8) | At(3) : 0; | |
115 | uint32_t iTime = (Size() >= 8) ? (At(4) << 24) | (At(5) << 16) | (At(6) << 8) | At(7) : 0; | |
116 | strMsg.AppendFormat(" line:%u", iLine); | |
117 | strMsg.AppendFormat(" time:%u", iTime); | |
118 | } | |
119 | break; | |
120 | case MSGCODE_FRAME_START: | |
121 | if (Size() >= 3) | |
122 | strMsg.AppendFormat(" initiator:%1x destination:%1x ack:%s %s", Initiator(), Destination(), IsACK() ? "high" : "low", IsEOM() ? "eom" : ""); | |
123 | break; | |
124 | case MSGCODE_FRAME_DATA: | |
125 | if (Size() >= 3) | |
126 | strMsg.AppendFormat(" %02x %s", At(2), IsEOM() ? "eom" : ""); | |
127 | break; | |
128 | default: | |
3ead056c LOK |
129 | if (Size() >= 2 && (Message() == MSGCODE_COMMAND_ACCEPTED || Message() == MSGCODE_COMMAND_REJECTED)) |
130 | strMsg.AppendFormat(": %s", ToString((cec_adapter_messagecode)At(2))); | |
131 | else | |
132 | { | |
133 | for (uint8_t iPtr = 2; iPtr < Size(); iPtr++) | |
134 | if (At(iPtr) != MSGEND) | |
135 | strMsg.AppendFormat(" %02x", At(iPtr)); | |
136 | } | |
a75e3a5a LOK |
137 | break; |
138 | } | |
139 | } | |
140 | ||
2b44051c | 141 | return std::string(strMsg.c_str()); |
a75e3a5a LOK |
142 | } |
143 | ||
144 | const char *CCECAdapterMessage::ToString(cec_adapter_messagecode msgCode) | |
145 | { | |
146 | switch (msgCode) | |
147 | { | |
148 | case MSGCODE_NOTHING: | |
149 | return "NOTHING"; | |
150 | case MSGCODE_PING: | |
151 | return "PING"; | |
152 | case MSGCODE_TIMEOUT_ERROR: | |
153 | return "TIMEOUT"; | |
154 | case MSGCODE_HIGH_ERROR: | |
155 | return "HIGH_ERROR"; | |
156 | case MSGCODE_LOW_ERROR: | |
157 | return "LOW_ERROR"; | |
158 | case MSGCODE_FRAME_START: | |
159 | return "FRAME_START"; | |
160 | case MSGCODE_FRAME_DATA: | |
161 | return "FRAME_DATA"; | |
162 | case MSGCODE_RECEIVE_FAILED: | |
163 | return "RECEIVE_FAILED"; | |
164 | case MSGCODE_COMMAND_ACCEPTED: | |
165 | return "COMMAND_ACCEPTED"; | |
166 | case MSGCODE_COMMAND_REJECTED: | |
167 | return "COMMAND_REJECTED"; | |
168 | case MSGCODE_SET_ACK_MASK: | |
169 | return "SET_ACK_MASK"; | |
170 | case MSGCODE_TRANSMIT: | |
171 | return "TRANSMIT"; | |
172 | case MSGCODE_TRANSMIT_EOM: | |
173 | return "TRANSMIT_EOM"; | |
174 | case MSGCODE_TRANSMIT_IDLETIME: | |
175 | return "TRANSMIT_IDLETIME"; | |
176 | case MSGCODE_TRANSMIT_ACK_POLARITY: | |
7ff1180d | 177 | return "CEC transmission"; |
a75e3a5a LOK |
178 | case MSGCODE_TRANSMIT_LINE_TIMEOUT: |
179 | return "TRANSMIT_LINE_TIMEOUT"; | |
180 | case MSGCODE_TRANSMIT_SUCCEEDED: | |
181 | return "TRANSMIT_SUCCEEDED"; | |
182 | case MSGCODE_TRANSMIT_FAILED_LINE: | |
183 | return "TRANSMIT_FAILED_LINE"; | |
184 | case MSGCODE_TRANSMIT_FAILED_ACK: | |
185 | return "TRANSMIT_FAILED_ACK"; | |
186 | case MSGCODE_TRANSMIT_FAILED_TIMEOUT_DATA: | |
187 | return "TRANSMIT_FAILED_TIMEOUT_DATA"; | |
188 | case MSGCODE_TRANSMIT_FAILED_TIMEOUT_LINE: | |
189 | return "TRANSMIT_FAILED_TIMEOUT_LINE"; | |
190 | case MSGCODE_FIRMWARE_VERSION: | |
191 | return "FIRMWARE_VERSION"; | |
192 | case MSGCODE_START_BOOTLOADER: | |
193 | return "START_BOOTLOADER"; | |
194 | case MSGCODE_FRAME_EOM: | |
195 | return "FRAME_EOM"; | |
196 | case MSGCODE_FRAME_ACK: | |
197 | return "FRAME_ACK"; | |
b2f56d35 LOK |
198 | case MSGCODE_GET_BUILDDATE: |
199 | return "GET_BUILDDATE"; | |
a75e3a5a LOK |
200 | case MSGCODE_SET_CONTROLLED: |
201 | return "SET_CONTROLLED"; | |
202 | case MSGCODE_GET_AUTO_ENABLED: | |
203 | return "GET_AUTO_ENABLED"; | |
204 | case MSGCODE_SET_AUTO_ENABLED: | |
205 | return "SET_AUTO_ENABLED"; | |
206 | case MSGCODE_GET_DEFAULT_LOGICAL_ADDRESS: | |
207 | return "GET_DEFAULT_LOGICAL_ADDRESS"; | |
208 | case MSGCODE_SET_DEFAULT_LOGICAL_ADDRESS: | |
209 | return "SET_DEFAULT_LOGICAL_ADDRESS"; | |
210 | case MSGCODE_GET_LOGICAL_ADDRESS_MASK: | |
211 | return "GET_LOGICAL_ADDRESS_MASK"; | |
212 | case MSGCODE_SET_LOGICAL_ADDRESS_MASK: | |
213 | return "SET_LOGICAL_ADDRESS_MASK"; | |
214 | case MSGCODE_GET_PHYSICAL_ADDRESS: | |
215 | return "GET_PHYSICAL_ADDRESS"; | |
216 | case MSGCODE_SET_PHYSICAL_ADDRESS: | |
217 | return "SET_PHYSICAL_ADDRESS"; | |
218 | case MSGCODE_GET_DEVICE_TYPE: | |
219 | return "GET_DEVICE_TYPE"; | |
220 | case MSGCODE_SET_DEVICE_TYPE: | |
221 | return "SET_DEVICE_TYPE"; | |
222 | case MSGCODE_GET_HDMI_VERSION: | |
223 | return "GET_HDMI_VERSION"; | |
224 | case MSGCODE_SET_HDMI_VERSION: | |
225 | return "SET_HDMI_VERSION"; | |
226 | case MSGCODE_GET_OSD_NAME: | |
227 | return "GET_OSD_NAME"; | |
228 | case MSGCODE_SET_OSD_NAME: | |
229 | return "SET_OSD_NAME"; | |
230 | case MSGCODE_WRITE_EEPROM: | |
231 | return "WRITE_EEPROM"; | |
2d418322 LOK |
232 | case MSGCODE_GET_ADAPTER_TYPE: |
233 | return "GET_ADAPTER_TYPE"; | |
b2f56d35 LOK |
234 | default: |
235 | break; | |
a75e3a5a LOK |
236 | } |
237 | ||
238 | return "unknown"; | |
239 | } | |
240 | ||
241 | uint8_t CCECAdapterMessage::operator[](uint8_t pos) const | |
242 | { | |
243 | return pos < packet.size ? packet[pos] : 0; | |
244 | } | |
245 | ||
246 | uint8_t CCECAdapterMessage::At(uint8_t pos) const | |
247 | { | |
248 | return pos < packet.size ? packet[pos] : 0; | |
249 | } | |
250 | ||
251 | uint8_t CCECAdapterMessage::Size(void) const | |
252 | { | |
253 | return packet.size; | |
254 | } | |
255 | ||
256 | bool CCECAdapterMessage::IsEmpty(void) const | |
257 | { | |
258 | return packet.IsEmpty(); | |
259 | } | |
260 | ||
261 | void CCECAdapterMessage::Clear(void) | |
262 | { | |
263 | state = ADAPTER_MESSAGE_STATE_UNKNOWN; | |
264 | transmit_timeout = CEC_DEFAULT_TRANSMIT_TIMEOUT; | |
265 | response.Clear(); | |
266 | packet.Clear(); | |
a75e3a5a | 267 | lineTimeout = 3; |
a75e3a5a | 268 | bNextByteIsEscaped = false; |
daec0320 | 269 | bFireAndForget = false; |
a75e3a5a LOK |
270 | } |
271 | ||
272 | void CCECAdapterMessage::Shift(uint8_t iShiftBy) | |
273 | { | |
274 | packet.Shift(iShiftBy); | |
275 | } | |
276 | ||
277 | void CCECAdapterMessage::Append(CCECAdapterMessage &data) | |
278 | { | |
279 | Append(data.packet); | |
280 | } | |
281 | ||
282 | void CCECAdapterMessage::Append(cec_datapacket &data) | |
283 | { | |
284 | for (uint8_t iPtr = 0; iPtr < data.size; iPtr++) | |
285 | PushBack(data[iPtr]); | |
286 | } | |
287 | ||
288 | void CCECAdapterMessage::PushBack(uint8_t byte) | |
289 | { | |
290 | packet.PushBack(byte); | |
291 | } | |
292 | ||
293 | void CCECAdapterMessage::PushEscaped(uint8_t byte) | |
294 | { | |
295 | if (byte >= MSGESC) | |
296 | { | |
297 | PushBack(MSGESC); | |
298 | PushBack(byte - ESCOFFSET); | |
299 | } | |
300 | else | |
301 | { | |
302 | PushBack(byte); | |
303 | } | |
304 | } | |
305 | ||
306 | bool CCECAdapterMessage::PushReceivedByte(uint8_t byte) | |
307 | { | |
308 | if (byte == MSGSTART) | |
309 | { | |
310 | if (HasStartMessage()) | |
311 | { | |
004b8382 | 312 | //TODO CLibCEC::AddLog(CEC_LOG_WARNING, "received MSGSTART before MSGEND, removing previous buffer contents"); |
a75e3a5a LOK |
313 | Clear(); |
314 | } | |
315 | PushBack(byte); | |
316 | } | |
317 | else | |
318 | { | |
319 | if (bNextByteIsEscaped) | |
320 | { | |
321 | PushBack(byte + (uint8_t)ESCOFFSET); | |
322 | bNextByteIsEscaped = false; | |
323 | } | |
324 | else if (byte == MSGESC) | |
325 | bNextByteIsEscaped = true; | |
326 | else | |
327 | PushBack(byte); | |
328 | } | |
329 | ||
330 | return byte == MSGEND; | |
331 | } | |
332 | ||
333 | cec_adapter_messagecode CCECAdapterMessage::Message(void) const | |
334 | { | |
335 | return packet.size >= 2 ? | |
336 | (cec_adapter_messagecode) (packet.At(1) & ~(MSGCODE_FRAME_EOM | MSGCODE_FRAME_ACK)) : | |
337 | MSGCODE_NOTHING; | |
338 | } | |
339 | ||
3ead056c LOK |
340 | cec_adapter_messagecode CCECAdapterMessage::ResponseTo(void) const |
341 | { | |
342 | return packet.size >= 3 ? | |
343 | (cec_adapter_messagecode) (packet.At(2) & ~(MSGCODE_FRAME_EOM | MSGCODE_FRAME_ACK)) : | |
344 | MSGCODE_NOTHING; | |
345 | } | |
346 | ||
a75e3a5a LOK |
347 | bool CCECAdapterMessage::IsTranmission(void) const |
348 | { | |
349 | cec_adapter_messagecode msgCode = Message(); | |
350 | return msgCode == MSGCODE_FRAME_ACK || | |
351 | msgCode == MSGCODE_FRAME_DATA || | |
352 | msgCode == MSGCODE_FRAME_EOM || | |
353 | msgCode == MSGCODE_FRAME_START || | |
354 | msgCode == MSGCODE_HIGH_ERROR || | |
355 | msgCode == MSGCODE_LOW_ERROR || | |
356 | msgCode == MSGCODE_RECEIVE_FAILED || | |
357 | msgCode == MSGCODE_TRANSMIT_ACK_POLARITY || | |
358 | msgCode == MSGCODE_TRANSMIT_EOM || | |
359 | msgCode == MSGCODE_TRANSMIT_FAILED_ACK || | |
360 | msgCode == MSGCODE_TRANSMIT_FAILED_LINE || | |
361 | msgCode == MSGCODE_TRANSMIT_FAILED_TIMEOUT_DATA || | |
362 | msgCode == MSGCODE_TRANSMIT_FAILED_TIMEOUT_LINE || | |
363 | msgCode == MSGCODE_TRANSMIT_LINE_TIMEOUT || | |
364 | msgCode == MSGCODE_TRANSMIT_SUCCEEDED; | |
365 | } | |
366 | ||
367 | bool CCECAdapterMessage::IsEOM(void) const | |
368 | { | |
369 | return packet.size >= 2 ? | |
370 | (packet.At(1) & MSGCODE_FRAME_EOM) != 0 : | |
371 | false; | |
372 | } | |
373 | ||
374 | bool CCECAdapterMessage::IsACK(void) const | |
375 | { | |
376 | return packet.size >= 2 ? | |
377 | (packet.At(1) & MSGCODE_FRAME_ACK) != 0 : | |
378 | false; | |
379 | } | |
380 | ||
815dbda2 | 381 | bool CCECAdapterMessage::MessageCodeIsError(const cec_adapter_messagecode code) |
a75e3a5a | 382 | { |
a75e3a5a | 383 | return (code == MSGCODE_HIGH_ERROR || |
815dbda2 LOK |
384 | code == MSGCODE_LOW_ERROR || |
385 | code == MSGCODE_RECEIVE_FAILED || | |
386 | code == MSGCODE_COMMAND_REJECTED || | |
387 | code == MSGCODE_TRANSMIT_LINE_TIMEOUT || | |
388 | code == MSGCODE_TRANSMIT_FAILED_LINE || | |
389 | code == MSGCODE_TRANSMIT_FAILED_ACK || | |
390 | code == MSGCODE_TRANSMIT_FAILED_TIMEOUT_DATA || | |
391 | code == MSGCODE_TRANSMIT_FAILED_TIMEOUT_LINE); | |
392 | } | |
393 | ||
394 | bool CCECAdapterMessage::IsError(void) const | |
395 | { | |
396 | return MessageCodeIsError(Message()); | |
397 | } | |
398 | ||
399 | bool CCECAdapterMessage::ReplyIsError(void) const | |
400 | { | |
401 | return MessageCodeIsError(Reply()); | |
a75e3a5a LOK |
402 | } |
403 | ||
404 | bool CCECAdapterMessage::NeedsRetry(void) const | |
405 | { | |
406 | return Reply() == MSGCODE_NOTHING || | |
407 | Reply() == MSGCODE_RECEIVE_FAILED || | |
408 | Reply() == MSGCODE_TIMEOUT_ERROR || | |
409 | Reply() == MSGCODE_TRANSMIT_FAILED_LINE || | |
410 | Reply() == MSGCODE_TRANSMIT_FAILED_TIMEOUT_DATA || | |
411 | Reply() == MSGCODE_TRANSMIT_FAILED_TIMEOUT_LINE || | |
412 | Reply() == MSGCODE_TRANSMIT_LINE_TIMEOUT; | |
413 | } | |
414 | ||
415 | cec_logical_address CCECAdapterMessage::Initiator(void) const | |
416 | { | |
417 | return packet.size >= 3 ? | |
418 | (cec_logical_address) (packet.At(2) >> 4) : | |
419 | CECDEVICE_UNKNOWN; | |
420 | } | |
421 | ||
422 | cec_logical_address CCECAdapterMessage::Destination(void) const | |
423 | { | |
424 | return packet.size >= 3 ? | |
425 | (cec_logical_address) (packet.At(2) & 0xF) : | |
426 | CECDEVICE_UNKNOWN; | |
427 | } | |
428 | ||
429 | bool CCECAdapterMessage::HasStartMessage(void) const | |
430 | { | |
431 | return packet.size >= 1 && packet.At(0) == MSGSTART; | |
432 | } | |
433 | ||
434 | bool CCECAdapterMessage::PushToCecCommand(cec_command &command) const | |
435 | { | |
436 | // empty message | |
437 | if (IsEmpty()) | |
438 | return false; | |
439 | ||
440 | cec_adapter_messagecode msgCode = Message(); | |
441 | if (msgCode == MSGCODE_FRAME_START) | |
442 | { | |
443 | command.Clear(); | |
444 | if (Size() >= 3) | |
445 | { | |
446 | command.initiator = Initiator(); | |
447 | command.destination = Destination(); | |
448 | command.ack = IsACK(); | |
449 | command.eom = IsEOM(); | |
450 | } | |
451 | return IsEOM() && !IsError(); | |
452 | } | |
453 | else if (msgCode == MSGCODE_FRAME_DATA) | |
454 | { | |
455 | if (Size() >= 3) | |
456 | { | |
457 | command.PushBack(At(2)); | |
458 | command.eom = IsEOM(); | |
459 | } | |
460 | return IsEOM() && !IsError(); | |
461 | } | |
462 | ||
463 | return false; | |
464 | } | |
465 | ||
466 | cec_adapter_messagecode CCECAdapterMessage::Reply(void) const | |
467 | { | |
468 | return response.size >= 2 ? | |
469 | (cec_adapter_messagecode) (response.At(1) & ~(MSGCODE_FRAME_EOM | MSGCODE_FRAME_ACK)) : | |
470 | MSGCODE_NOTHING; | |
471 | } |