cec: re-enabled AddCommand(). debug leftover
[deb_libcec.git] / src / lib / CECProcessor.cpp
CommitLineData
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 35#include "AdapterCommunication.h"
eafa9d46 36#include "devices/CECBusDevice.h"
2abe74eb 37#include "LibCEC.h"
abbca718 38#include "util/StdString.h"
b9187cc6 39#include "platform/timeutils.h"
abbca718
LOK
40
41using namespace CEC;
42using namespace std;
43
2b4d8297 44CCECProcessor::CCECProcessor(CLibCEC *controller, CAdapterCommunication *serComm, const char *strDeviceName, cec_logical_address iLogicalAddress /* = CECDEVICE_PLAYBACKDEVICE1 */, uint16_t iPhysicalAddress /* = CEC_DEFAULT_PHYSICAL_ADDRESS*/) :
179efe86 45 m_iLogicalAddress(iLogicalAddress),
2abe74eb
LOK
46 m_strDeviceName(strDeviceName),
47 m_communication(serComm),
8b7e5ff6 48 m_controller(controller),
06bfd4d7 49 m_bMonitor(false)
abbca718 50{
7ea0d558 51 for (int iPtr = 0; iPtr < 16; iPtr++)
09c10b66 52 m_busDevices[iPtr] = new CCECBusDevice(this, (cec_logical_address) iPtr, iPtr == iLogicalAddress ? iPhysicalAddress : 0);
abbca718
LOK
53}
54
2abe74eb 55CCECProcessor::~CCECProcessor(void)
abbca718 56{
8b0ee2cc 57 m_startCondition.Broadcast();
2abe74eb
LOK
58 StopThread();
59 m_communication = NULL;
60 m_controller = NULL;
d1998c7b
LOK
61 for (unsigned int iPtr = 0; iPtr < 16; iPtr++)
62 delete m_busDevices[iPtr];
abbca718
LOK
63}
64
2abe74eb 65bool CCECProcessor::Start(void)
abbca718 66{
8b0ee2cc 67 CLockObject lock(&m_mutex);
2abe74eb 68 if (!m_communication || !m_communication->IsOpen())
13fd6a66
LOK
69 {
70 m_controller->AddLog(CEC_LOG_ERROR, "connection is closed");
a8f0bd18 71 return false;
13fd6a66 72 }
abbca718 73
60fa4578 74 if (CreateThread())
8b0ee2cc
LOK
75 {
76 if (!m_startCondition.Wait(&m_mutex))
77 {
78 m_controller->AddLog(CEC_LOG_ERROR, "could not create a processor thread");
79 return false;
80 }
a8f0bd18 81 return true;
8b0ee2cc 82 }
a8f0bd18 83 else
2abe74eb 84 m_controller->AddLog(CEC_LOG_ERROR, "could not create a processor thread");
abbca718 85
a8f0bd18 86 return false;
abbca718
LOK
87}
88
2abe74eb 89void *CCECProcessor::Process(void)
f99bc831 90{
e0407d3d
LOK
91 cec_command command;
92 CCECAdapterMessage msg;
93
94 SetAckMask(0x1 << (uint8_t)m_iLogicalAddress);
95
8b0ee2cc
LOK
96 {
97 CLockObject lock(&m_mutex);
98 m_controller->AddLog(CEC_LOG_DEBUG, "processor thread started");
99 m_startCondition.Signal();
100 }
abbca718 101
13fd6a66 102 while (!IsStopped())
abbca718 103 {
60fa4578 104 bool bParseFrame(false);
9dee1670 105 command.clear();
76321de4
LOK
106 msg.clear();
107
60fa4578
LOK
108 {
109 CLockObject lock(&m_mutex);
88c43521 110 if (m_communication->IsOpen() && m_communication->Read(msg, 50))
b5f34cf9
LOK
111 {
112 m_controller->AddLog(msg.is_error() ? CEC_LOG_WARNING : CEC_LOG_DEBUG, msg.ToString());
88c43521 113 bParseFrame = ParseMessage(msg) && !IsStopped();
b5f34cf9 114 }
76321de4
LOK
115
116 if (bParseFrame)
9dee1670 117 command = m_currentframe;
60fa4578
LOK
118 }
119
13fd6a66 120 if (bParseFrame)
9dee1670 121 ParseCommand(command);
abbca718 122
b5f34cf9
LOK
123 Sleep(5);
124
13fd6a66
LOK
125 m_controller->CheckKeypressTimeout();
126
0ab58650
LOK
127 for (unsigned int iDevicePtr = 0; iDevicePtr < 16; iDevicePtr++)
128 m_busDevices[iDevicePtr]->PollVendorId();
129
b5f34cf9 130 Sleep(5);
abbca718
LOK
131 }
132
60fa4578 133 return NULL;
abbca718
LOK
134}
135
2abe74eb 136bool CCECProcessor::SetActiveView(void)
abbca718 137{
60fa4578 138 if (!IsRunning())
f99bc831
LOK
139 return false;
140
cc60ab1c
LOK
141 if (m_iLogicalAddress != CECDEVICE_UNKNOWN && m_busDevices[m_iLogicalAddress])
142 return m_busDevices[m_iLogicalAddress]->BroadcastActiveView();
143 return false;
abbca718
LOK
144}
145
2abe74eb 146bool CCECProcessor::SetInactiveView(void)
abbca718 147{
60fa4578 148 if (!IsRunning())
f99bc831
LOK
149 return false;
150
cc60ab1c
LOK
151 if (m_iLogicalAddress != CECDEVICE_UNKNOWN && m_busDevices[m_iLogicalAddress])
152 return m_busDevices[m_iLogicalAddress]->BroadcastInactiveView();
153 return false;
abbca718
LOK
154}
155
9dee1670 156void CCECProcessor::LogOutput(const cec_command &data)
abbca718 157{
1d3ca3de
LOK
158 CStdString strTx;
159 strTx.Format("<< %02x:%02x", ((uint8_t)data.initiator << 4) + (uint8_t)data.destination, (uint8_t)data.opcode);
9dee1670 160
06a1f7ce 161 for (uint8_t iPtr = 0; iPtr < data.parameters.size; iPtr++)
1d3ca3de
LOK
162 strTx.AppendFormat(":%02x", data.parameters[iPtr]);
163 m_controller->AddLog(CEC_LOG_TRAFFIC, strTx.c_str());
9dee1670 164}
2abe74eb 165
06bfd4d7 166bool CCECProcessor::SetLogicalAddress(cec_logical_address iLogicalAddress)
abbca718 167{
06bfd4d7 168 if (m_iLogicalAddress != iLogicalAddress)
06775107
LOK
169 {
170 CStdString strLog;
171 strLog.Format("<< setting logical address to %1x", iLogicalAddress);
172 m_controller->AddLog(CEC_LOG_NOTICE, strLog.c_str());
06775107 173 m_iLogicalAddress = iLogicalAddress;
06bfd4d7 174 return SetAckMask(0x1 << (uint8_t)m_iLogicalAddress);
06775107 175 }
2abe74eb 176
06bfd4d7 177 return true;
abbca718 178}
825ddb96 179
2492216a
LOK
180bool CCECProcessor::SetPhysicalAddress(uint16_t iPhysicalAddress)
181{
cc60ab1c
LOK
182 if (m_iLogicalAddress != CECDEVICE_UNKNOWN && m_busDevices[m_iLogicalAddress])
183 {
184 m_busDevices[m_iLogicalAddress]->SetPhysicalAddress(iPhysicalAddress);
185 return m_busDevices[m_iLogicalAddress]->BroadcastActiveView();
186 }
187 return false;
1969b140
LOK
188}
189
8b7e5ff6
LOK
190bool CCECProcessor::SwitchMonitoring(bool bEnable)
191{
192 CStdString strLog;
193 strLog.Format("== %s monitoring mode ==", bEnable ? "enabling" : "disabling");
194 m_controller->AddLog(CEC_LOG_NOTICE, strLog.c_str());
195
196 m_bMonitor = bEnable;
197 if (bEnable)
06bfd4d7 198 return SetAckMask(0);
8b7e5ff6 199 else
06bfd4d7 200 return SetAckMask(0x1 << (uint8_t)m_iLogicalAddress);
8b7e5ff6
LOK
201}
202
6a1c0009
LOK
203cec_version CCECProcessor::GetDeviceCecVersion(cec_logical_address iAddress)
204{
205 return m_busDevices[iAddress]->GetCecVersion();
206}
207
a3269a0a
LOK
208bool CCECProcessor::GetDeviceMenuLanguage(cec_logical_address iAddress, cec_menu_language *language)
209{
cc60ab1c
LOK
210 if (m_busDevices[iAddress])
211 {
212 *language = m_busDevices[iAddress]->GetMenuLanguage();
5744fbba 213 return (strcmp(language->language, "???") != 0);
cc60ab1c
LOK
214 }
215 return false;
a3269a0a
LOK
216}
217
44c74256
LOK
218uint64_t CCECProcessor::GetDeviceVendorId(cec_logical_address iAddress)
219{
cc60ab1c
LOK
220 if (m_busDevices[iAddress])
221 return m_busDevices[iAddress]->GetVendorId();
222 return false;
44c74256
LOK
223}
224
e55f3f70
LOK
225cec_power_status CCECProcessor::GetDevicePowerStatus(cec_logical_address iAddress)
226{
cc60ab1c
LOK
227 if (m_busDevices[iAddress])
228 return m_busDevices[iAddress]->GetPowerStatus();
229 return CEC_POWER_STATUS_UNKNOWN;
e55f3f70
LOK
230}
231
8d84e2c0 232bool CCECProcessor::Transmit(const cec_command &data)
825ddb96 233{
13929cff
LOK
234 LogOutput(data);
235
5a1e87c8 236 CCECAdapterMessagePtr output(new CCECAdapterMessage(data));
06bfd4d7
LOK
237 return Transmit(output);
238}
13929cff 239
06bfd4d7
LOK
240bool CCECProcessor::Transmit(CCECAdapterMessagePtr output)
241{
242 bool bReturn(false);
2abe74eb 243 CLockObject lock(&m_mutex);
eb35e4ca
LOK
244 {
245 CLockObject msgLock(&output->mutex);
246 if (!m_communication || !m_communication->Write(output))
247 return bReturn;
248 else
0e31a62c 249 {
e4613795 250 output->condition.Wait(&output->mutex, 1000);
0e31a62c
LOK
251 if (output->state != ADAPTER_MESSAGE_STATE_SENT)
252 {
253 m_controller->AddLog(CEC_LOG_ERROR, "command was not sent");
254 return bReturn;
255 }
256 }
2abe74eb 257
06bfd4d7 258 if (output->transmit_timeout > 0)
cd505625 259 {
06bfd4d7 260 if ((bReturn = WaitForTransmitSucceeded(output->size(), output->transmit_timeout)) == false)
cd505625
LOK
261 m_controller->AddLog(CEC_LOG_ERROR, "did not receive ack");
262 }
263 else
cd505625 264 bReturn = true;
2abe74eb
LOK
265 }
266
7ea0d558 267 return bReturn;
825ddb96 268}
abbca718 269
2abe74eb 270void CCECProcessor::TransmitAbort(cec_logical_address address, cec_opcode opcode, ECecAbortReason reason /* = CEC_ABORT_REASON_UNRECOGNIZED_OPCODE */)
abbca718 271{
9dee1670
LOK
272 m_controller->AddLog(CEC_LOG_DEBUG, "<< transmitting abort message");
273
06a1f7ce
LOK
274 cec_command command;
275 cec_command::format(command, m_iLogicalAddress, address, CEC_OPCODE_FEATURE_ABORT);
9dee1670
LOK
276 command.parameters.push_back((uint8_t)opcode);
277 command.parameters.push_back((uint8_t)reason);
278
279 Transmit(command);
abbca718
LOK
280}
281
1f0e9e0f 282bool CCECProcessor::WaitForTransmitSucceeded(uint8_t iLength, uint32_t iTimeout /* = 1000 */)
abbca718 283{
1f0e9e0f
LOK
284 bool bError(false);
285 bool bTransmitSucceeded(false);
7ea0d558 286 uint8_t iPacketsLeft(iLength / 4);
abbca718
LOK
287
288 int64_t iNow = GetTimeMs();
25701fa6 289 int64_t iTargetTime = iNow + (uint64_t) iTimeout;
abbca718 290
1f0e9e0f 291 while (!bTransmitSucceeded && !bError && (iTimeout == 0 || iNow < iTargetTime))
abbca718 292 {
220537f2 293 CCECAdapterMessage msg;
25701fa6 294
06a1f7ce 295 if (!m_communication->Read(msg, iTimeout > 0 ? (int32_t)(iTargetTime - iNow) : 1000))
abbca718 296 {
abbca718 297 iNow = GetTimeMs();
5d38b0b6
LOK
298 continue;
299 }
300
edab6137 301 if ((bError = msg.is_error()) == false)
7ea0d558 302 {
0544ff56
LOK
303 m_controller->AddLog(bError ? CEC_LOG_WARNING : CEC_LOG_DEBUG, msg.ToString());
304
edab6137
LOK
305 switch(msg.message())
306 {
307 case MSGCODE_COMMAND_ACCEPTED:
308 if (iPacketsLeft > 0)
309 iPacketsLeft--;
310 break;
311 case MSGCODE_TRANSMIT_SUCCEEDED:
312 bTransmitSucceeded = (iPacketsLeft == 0);
313 bError = !bTransmitSucceeded;
314 break;
315 default:
316 ParseMessage(msg);
317 }
7ea0d558 318
edab6137
LOK
319 iNow = GetTimeMs();
320 }
abbca718
LOK
321 }
322
1f0e9e0f 323 return bTransmitSucceeded && !bError;
abbca718
LOK
324}
325
0e7b6c54 326bool CCECProcessor::ParseMessage(const CCECAdapterMessage &msg)
abbca718 327{
7ea0d558 328 bool bEom = false;
60fa4578 329
0e7b6c54 330 if (msg.empty())
7ea0d558 331 return bEom;
abbca718 332
0e7b6c54 333 switch(msg.message())
abbca718 334 {
abbca718
LOK
335 case MSGCODE_FRAME_START:
336 {
7ea0d558 337 m_currentframe.clear();
0e7b6c54 338 if (msg.size() >= 2)
abbca718 339 {
0e7b6c54
LOK
340 m_currentframe.initiator = msg.initiator();
341 m_currentframe.destination = msg.destination();
342 m_currentframe.ack = msg.ack();
343 m_currentframe.eom = msg.eom();
abbca718 344 }
abbca718
LOK
345 }
346 break;
347 case MSGCODE_FRAME_DATA:
348 {
0e7b6c54 349 if (msg.size() >= 2)
78e8010a 350 {
e41b06f9 351 m_currentframe.push_back(msg[1]);
0e7b6c54 352 m_currentframe.eom = msg.eom();
abbca718 353 }
0e7b6c54 354 bEom = msg.eom();
abbca718 355 }
78e8010a 356 break;
abbca718
LOK
357 default:
358 break;
359 }
7ea0d558
LOK
360
361 return bEom;
abbca718
LOK
362}
363
e9de9629 364void CCECProcessor::ParseCommand(cec_command &command)
abbca718 365{
e9de9629 366 CStdString dataStr;
1d3ca3de 367 dataStr.Format(">> %1x%1x:%02x", command.initiator, command.destination, command.opcode);
e9de9629
LOK
368 for (uint8_t iPtr = 0; iPtr < command.parameters.size; iPtr++)
369 dataStr.AppendFormat(":%02x", (unsigned int)command.parameters[iPtr]);
1d3ca3de 370 m_controller->AddLog(CEC_LOG_TRAFFIC, dataStr.c_str());
dc113aca 371
e9de9629
LOK
372 if (!m_bMonitor)
373 m_busDevices[(uint8_t)command.initiator]->HandleCommand(command);
dc113aca
LOK
374}
375
0f23c85c
LOK
376uint16_t CCECProcessor::GetPhysicalAddress(void) const
377{
cc60ab1c
LOK
378 if (m_iLogicalAddress != CECDEVICE_UNKNOWN && m_busDevices[m_iLogicalAddress])
379 return m_busDevices[m_iLogicalAddress]->GetPhysicalAddress();
380 return false;
0f23c85c
LOK
381}
382
e9de9629 383void CCECProcessor::SetCurrentButton(cec_user_control_code iButtonCode)
dc113aca 384{
e9de9629 385 m_controller->SetCurrentButton(iButtonCode);
dc113aca
LOK
386}
387
e9de9629 388void CCECProcessor::AddCommand(const cec_command &command)
dc113aca 389{
0544ff56 390 m_controller->AddCommand(command);
dc113aca
LOK
391}
392
e9de9629 393void CCECProcessor::AddKey(void)
dc113aca 394{
e9de9629 395 m_controller->AddKey();
abbca718 396}
acec5f48 397
e9de9629 398void CCECProcessor::AddLog(cec_log_level level, const CStdString &strMessage)
acec5f48 399{
e9de9629 400 m_controller->AddLog(level, strMessage);
acec5f48 401}
06bfd4d7
LOK
402
403bool CCECProcessor::SetAckMask(uint16_t iMask)
404{
405 CStdString strLog;
406 strLog.Format("setting ackmask to %2x", iMask);
407 m_controller->AddLog(CEC_LOG_DEBUG, strLog.c_str());
408
409 CCECAdapterMessagePtr output(new CCECAdapterMessage);
410
411 output->push_back(MSGSTART);
412 output->push_escaped(MSGCODE_SET_ACK_MASK);
413 output->push_escaped(iMask >> 8);
414 output->push_escaped((uint8_t)iMask);
415 output->push_back(MSGEND);
416
417 if (!Transmit(output))
418 {
419 m_controller->AddLog(CEC_LOG_ERROR, "could not set the ackmask");
420 return false;
421 }
422
423 return true;
424}