2 * This file is part of the libCEC(R) library.
4 * libCEC(R) is Copyright (C) 2011 Pulse-Eight Limited. All rights reserved.
5 * libCEC(R) is an original work, containing original code.
7 * libCEC(R) is a trademark of Pulse-Eight Limited.
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.
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.
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.
24 * Alternatively, you can license this library under a commercial license,
25 * please contact Pulse-Eight Licensing for more information.
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/
33 #include "CECProcessor.h"
35 #include "AdapterCommunication.h"
36 #include "devices/CECBusDevice.h"
37 #include "devices/CECAudioSystem.h"
38 #include "devices/CECPlaybackDevice.h"
39 #include "devices/CECRecordingDevice.h"
40 #include "devices/CECTuner.h"
41 #include "devices/CECTV.h"
42 #include "implementations/CECCommandHandler.h"
44 #include "util/StdString.h"
45 #include "platform/timeutils.h"
50 CCECProcessor::CCECProcessor(CLibCEC
*controller
, CAdapterCommunication
*serComm
, const char *strDeviceName
, cec_logical_address iLogicalAddress
/* = CECDEVICE_PLAYBACKDEVICE1 */, uint16_t iPhysicalAddress
/* = CEC_DEFAULT_PHYSICAL_ADDRESS*/) :
52 m_strDeviceName(strDeviceName
),
53 m_communication(serComm
),
54 m_controller(controller
),
57 m_logicalAddresses
.clear();
58 m_logicalAddresses
.set(iLogicalAddress
);
60 for (int iPtr
= 0; iPtr
< 16; iPtr
++)
61 m_busDevices
[iPtr
] = new CCECBusDevice(this, (cec_logical_address
) iPtr
, iPtr
== iLogicalAddress
? iPhysicalAddress
: 0);
64 CCECProcessor::CCECProcessor(CLibCEC
*controller
, CAdapterCommunication
*serComm
, const char *strDeviceName
, const cec_device_type_list
&types
) :
66 m_strDeviceName(strDeviceName
),
68 m_communication(serComm
),
69 m_controller(controller
),
72 m_logicalAddresses
.clear();
73 for (int iPtr
= 0; iPtr
< 16; iPtr
++)
77 case CECDEVICE_AUDIOSYSTEM
:
78 m_busDevices
[iPtr
] = new CCECAudioSystem(this, (cec_logical_address
) iPtr
, 0xFFFF);
80 case CECDEVICE_PLAYBACKDEVICE1
:
81 case CECDEVICE_PLAYBACKDEVICE2
:
82 case CECDEVICE_PLAYBACKDEVICE3
:
83 m_busDevices
[iPtr
] = new CCECPlaybackDevice(this, (cec_logical_address
) iPtr
, 0xFFFF);
85 case CECDEVICE_RECORDINGDEVICE1
:
86 case CECDEVICE_RECORDINGDEVICE2
:
87 case CECDEVICE_RECORDINGDEVICE3
:
88 m_busDevices
[iPtr
] = new CCECRecordingDevice(this, (cec_logical_address
) iPtr
, 0xFFFF);
90 case CECDEVICE_TUNER1
:
91 case CECDEVICE_TUNER2
:
92 case CECDEVICE_TUNER3
:
93 case CECDEVICE_TUNER4
:
94 m_busDevices
[iPtr
] = new CCECTuner(this, (cec_logical_address
) iPtr
, 0xFFFF);
97 m_busDevices
[iPtr
] = new CCECTV(this, (cec_logical_address
) iPtr
, 0);
100 m_busDevices
[iPtr
] = new CCECBusDevice(this, (cec_logical_address
) iPtr
, 0xFFFF);
106 CCECProcessor::~CCECProcessor(void)
108 m_startCondition
.Broadcast();
110 m_communication
= NULL
;
112 for (unsigned int iPtr
= 0; iPtr
< 16; iPtr
++)
113 delete m_busDevices
[iPtr
];
116 bool CCECProcessor::Start(void)
118 CLockObject
lock(&m_mutex
);
119 if (!m_communication
|| !m_communication
->IsOpen())
121 m_controller
->AddLog(CEC_LOG_ERROR
, "connection is closed");
127 if (!m_startCondition
.Wait(&m_mutex
) || !m_bStarted
)
129 m_controller
->AddLog(CEC_LOG_ERROR
, "could not create a processor thread");
135 m_controller
->AddLog(CEC_LOG_ERROR
, "could not create a processor thread");
140 bool CCECProcessor::TryLogicalAddress(cec_logical_address address
, unsigned int iIndex
)
142 const char *strLabel
= CCECCommandHandler::ToString(address
);
144 strLog
.Format("trying logical address '%s'", strLabel
);
145 AddLog(CEC_LOG_DEBUG
, strLog
);
147 SetAckMask(0x1 << address
);
148 if (!m_busDevices
[address
]->TransmitPoll(address
))
150 strLog
.Format("using logical address '%s'", strLabel
);
151 AddLog(CEC_LOG_NOTICE
, strLog
);
153 /* only set our OSD name and active source for the primary device */
154 if (m_logicalAddresses
.empty())
156 m_busDevices
[address
]->m_strDeviceName
= m_strDeviceName
;
157 m_busDevices
[address
]->m_bActiveSource
= true;
159 m_busDevices
[address
]->m_powerStatus
= CEC_POWER_STATUS_STANDBY
;
160 m_busDevices
[address
]->m_cecVersion
= CEC_VERSION_1_3A
;
162 m_logicalAddresses
.set(address
);
165 m_busDevices
[address
]->SetPhysicalAddress((uint16_t)CEC_DEFAULT_PHYSICAL_ADDRESS
+ ((uint16_t)iIndex
* 0x100));
170 strLog
.Format("logical address '%s' already taken", strLabel
);
171 AddLog(CEC_LOG_DEBUG
, strLog
);
175 bool CCECProcessor::FindLogicalAddressRecordingDevice(unsigned int iIndex
)
177 AddLog(CEC_LOG_DEBUG
, "detecting logical address for type 'recording device'");
178 return TryLogicalAddress(CECDEVICE_RECORDINGDEVICE1
, iIndex
) ||
179 TryLogicalAddress(CECDEVICE_RECORDINGDEVICE2
, iIndex
) ||
180 TryLogicalAddress(CECDEVICE_RECORDINGDEVICE3
, iIndex
);
183 bool CCECProcessor::FindLogicalAddressTuner(unsigned int iIndex
)
185 AddLog(CEC_LOG_DEBUG
, "detecting logical address for type 'tuner'");
186 return TryLogicalAddress(CECDEVICE_TUNER1
, iIndex
) ||
187 TryLogicalAddress(CECDEVICE_TUNER2
, iIndex
) ||
188 TryLogicalAddress(CECDEVICE_TUNER3
, iIndex
) ||
189 TryLogicalAddress(CECDEVICE_TUNER4
, iIndex
);
192 bool CCECProcessor::FindLogicalAddressPlaybackDevice(unsigned int iIndex
)
194 AddLog(CEC_LOG_DEBUG
, "detecting logical address for type 'playback device'");
195 return TryLogicalAddress(CECDEVICE_PLAYBACKDEVICE1
, iIndex
) ||
196 TryLogicalAddress(CECDEVICE_PLAYBACKDEVICE2
, iIndex
) ||
197 TryLogicalAddress(CECDEVICE_PLAYBACKDEVICE3
, iIndex
);
200 bool CCECProcessor::FindLogicalAddressAudioSystem(unsigned int iIndex
)
202 AddLog(CEC_LOG_DEBUG
, "detecting logical address for type 'audio'");
203 return TryLogicalAddress(CECDEVICE_AUDIOSYSTEM
, iIndex
);
206 bool CCECProcessor::FindLogicalAddresses(void)
209 m_logicalAddresses
.clear();
212 for (unsigned int iPtr
= 0; iPtr
< 5; iPtr
++)
214 if (m_types
.types
[iPtr
] == CEC_DEVICE_TYPE_RESERVED
)
217 strLog
.Format("%s - device %d: type %d", __FUNCTION__
, iPtr
, m_types
.types
[iPtr
]);
218 AddLog(CEC_LOG_DEBUG
, strLog
);
220 if (m_types
.types
[iPtr
] == CEC_DEVICE_TYPE_RECORDING_DEVICE
)
221 bReturn
&= FindLogicalAddressRecordingDevice(iPtr
);
222 if (m_types
.types
[iPtr
] == CEC_DEVICE_TYPE_TUNER
)
223 bReturn
&= FindLogicalAddressTuner(iPtr
);
224 if (m_types
.types
[iPtr
] == CEC_DEVICE_TYPE_PLAYBACK_DEVICE
)
225 bReturn
&= FindLogicalAddressPlaybackDevice(iPtr
);
226 if (m_types
.types
[iPtr
] == CEC_DEVICE_TYPE_AUDIO_SYSTEM
)
227 bReturn
&= FindLogicalAddressAudioSystem(iPtr
);
233 void *CCECProcessor::Process(void)
235 bool bParseFrame(false);
237 CCECAdapterMessage msg
;
240 if (m_logicalAddresses
.empty() && !FindLogicalAddresses())
242 CLockObject
lock(&m_mutex
);
243 m_controller
->AddLog(CEC_LOG_ERROR
, "could not detect our logical addressed");
244 m_startCondition
.Signal();
248 SetAckMask(m_logicalAddresses
.ackmask());
251 CLockObject
lock(&m_mutex
);
252 m_controller
->AddLog(CEC_LOG_DEBUG
, "processor thread started");
254 m_startCondition
.Signal();
264 CLockObject
lock(&m_mutex
);
265 if (m_commandBuffer
.Pop(command
))
269 else if (m_communication
->IsOpen() && m_communication
->Read(msg
, 50))
271 m_controller
->AddLog(msg
.is_error() ? CEC_LOG_WARNING
: CEC_LOG_DEBUG
, msg
.ToString());
272 if ((bParseFrame
= (ParseMessage(msg
) && !IsStopped())) == true)
273 command
= m_currentframe
;
278 ParseCommand(command
);
283 m_controller
->CheckKeypressTimeout();
285 for (unsigned int iDevicePtr
= 0; iDevicePtr
< 16; iDevicePtr
++)
286 m_busDevices
[iDevicePtr
]->PollVendorId();
294 bool CCECProcessor::SetActiveSource(cec_device_type type
/* = CEC_DEVICE_TYPE_RESERVED */)
301 cec_logical_address addr
= m_logicalAddresses
.primary
;
303 if (type
!= CEC_DEVICE_TYPE_RESERVED
)
305 for (uint8_t iPtr
= 0; iPtr
< 16; iPtr
++)
307 if (m_logicalAddresses
[iPtr
] && m_busDevices
[iPtr
]->m_type
== type
)
309 addr
= (cec_logical_address
) iPtr
;
315 return SetStreamPath(m_busDevices
[addr
]->GetPhysicalAddress());
318 bool CCECProcessor::SetActiveView(void)
320 return SetActiveSource();
323 bool CCECProcessor::SetDeckControlMode(cec_deck_control_mode mode
, bool bSendUpdate
/* = true */)
327 CCECBusDevice
*device
= GetDeviceByType(CEC_DEVICE_TYPE_PLAYBACK_DEVICE
);
330 ((CCECPlaybackDevice
*) device
)->SetDeckControlMode(mode
);
332 ((CCECPlaybackDevice
*) device
)->TransmitDeckStatus(CECDEVICE_TV
);
339 bool CCECProcessor::SetDeckInfo(cec_deck_info info
, bool bSendUpdate
/* = true */)
343 CCECBusDevice
*device
= GetDeviceByType(CEC_DEVICE_TYPE_PLAYBACK_DEVICE
);
346 ((CCECPlaybackDevice
*) device
)->SetDeckStatus(info
);
348 ((CCECPlaybackDevice
*) device
)->TransmitDeckStatus(CECDEVICE_TV
);
355 bool CCECProcessor::SetStreamPath(uint16_t iStreamPath
)
359 CCECBusDevice
*device
= GetDeviceByPhysicalAddress(iStreamPath
);
362 for (unsigned int iPtr
= 0; iPtr
< 16; iPtr
++)
363 m_busDevices
[iPtr
]->m_bActiveSource
= false;
365 device
->m_bActiveSource
= true;
366 device
->m_powerStatus
= CEC_POWER_STATUS_ON
;
368 if (m_logicalAddresses
.isset(device
->m_iLogicalAddress
))
369 bReturn
= device
->TransmitActiveSource();
377 bool CCECProcessor::SetInactiveView(void)
382 if (!m_logicalAddresses
.empty() && m_busDevices
[m_logicalAddresses
.primary
])
383 return m_busDevices
[m_logicalAddresses
.primary
]->TransmitInactiveView();
387 void CCECProcessor::LogOutput(const cec_command
&data
)
390 strTx
.Format("<< %02x", ((uint8_t)data
.initiator
<< 4) + (uint8_t)data
.destination
);
392 strTx
.AppendFormat(":%02x", (uint8_t)data
.opcode
);
394 for (uint8_t iPtr
= 0; iPtr
< data
.parameters
.size
; iPtr
++)
395 strTx
.AppendFormat(":%02x", data
.parameters
[iPtr
]);
396 m_controller
->AddLog(CEC_LOG_TRAFFIC
, strTx
.c_str());
399 bool CCECProcessor::SetLogicalAddress(cec_logical_address iLogicalAddress
)
401 if (m_logicalAddresses
.primary
!= iLogicalAddress
)
404 strLog
.Format("<< setting primary logical address to %1x", iLogicalAddress
);
405 m_controller
->AddLog(CEC_LOG_NOTICE
, strLog
.c_str());
406 m_logicalAddresses
.primary
= iLogicalAddress
;
407 m_logicalAddresses
.set(iLogicalAddress
);
408 return SetAckMask(m_logicalAddresses
.ackmask());
414 bool CCECProcessor::SetMenuState(cec_menu_state state
, bool bSendUpdate
/* = true */)
416 for (uint8_t iPtr
= 0; iPtr
< 16; iPtr
++)
418 if (m_logicalAddresses
[iPtr
])
419 m_busDevices
[iPtr
]->SetMenuState(state
);
423 m_busDevices
[m_logicalAddresses
.primary
]->TransmitMenuState(CECDEVICE_TV
);
428 bool CCECProcessor::SetPhysicalAddress(uint16_t iPhysicalAddress
)
430 if (!m_logicalAddresses
.empty() && m_busDevices
[m_logicalAddresses
.primary
])
432 m_busDevices
[m_logicalAddresses
.primary
]->SetPhysicalAddress(iPhysicalAddress
);
433 return SetActiveView();
438 bool CCECProcessor::SwitchMonitoring(bool bEnable
)
441 strLog
.Format("== %s monitoring mode ==", bEnable
? "enabling" : "disabling");
442 m_controller
->AddLog(CEC_LOG_NOTICE
, strLog
.c_str());
444 m_bMonitor
= bEnable
;
446 return SetAckMask(0);
448 return SetAckMask(m_logicalAddresses
.ackmask());
451 bool CCECProcessor::PollDevice(cec_logical_address iAddress
)
453 if (iAddress
!= CECDEVICE_UNKNOWN
&& m_busDevices
[iAddress
])
454 return m_busDevices
[m_logicalAddresses
.primary
]->TransmitPoll(iAddress
);
458 CCECBusDevice
*CCECProcessor::GetDeviceByPhysicalAddress(uint16_t iPhysicalAddress
) const
460 CCECBusDevice
*device
= NULL
;
462 for (unsigned int iPtr
= 0; iPtr
< 16; iPtr
++)
464 if (m_busDevices
[iPtr
]->GetPhysicalAddress() == iPhysicalAddress
)
466 device
= m_busDevices
[iPtr
];
474 CCECBusDevice
*CCECProcessor::GetDeviceByType(cec_device_type type
) const
476 CCECBusDevice
*device
= NULL
;
478 for (unsigned int iPtr
= 0; iPtr
< 16; iPtr
++)
480 if (m_busDevices
[iPtr
]->m_type
== type
)
482 device
= m_busDevices
[iPtr
];
490 cec_version
CCECProcessor::GetDeviceCecVersion(cec_logical_address iAddress
)
492 return m_busDevices
[iAddress
]->GetCecVersion();
495 bool CCECProcessor::GetDeviceMenuLanguage(cec_logical_address iAddress
, cec_menu_language
*language
)
497 if (m_busDevices
[iAddress
])
499 *language
= m_busDevices
[iAddress
]->GetMenuLanguage();
500 return (strcmp(language
->language
, "???") != 0);
505 uint64_t CCECProcessor::GetDeviceVendorId(cec_logical_address iAddress
)
507 if (m_busDevices
[iAddress
])
508 return m_busDevices
[iAddress
]->GetVendorId();
512 cec_power_status
CCECProcessor::GetDevicePowerStatus(cec_logical_address iAddress
)
514 if (m_busDevices
[iAddress
])
515 return m_busDevices
[iAddress
]->GetPowerStatus();
516 return CEC_POWER_STATUS_UNKNOWN
;
519 bool CCECProcessor::Transmit(const cec_command
&data
)
524 CCECAdapterMessage
*output
= new CCECAdapterMessage(data
);
525 bReturn
= Transmit(output
);
531 bool CCECProcessor::Transmit(CCECAdapterMessage
*output
)
534 CLockObject
lock(&m_mutex
);
536 CLockObject
msgLock(&output
->mutex
);
537 if (!m_communication
|| !m_communication
->Write(output
))
541 output
->condition
.Wait(&output
->mutex
);
542 if (output
->state
!= ADAPTER_MESSAGE_STATE_SENT
)
544 m_controller
->AddLog(CEC_LOG_ERROR
, "command was not sent");
549 if (output
->transmit_timeout
> 0)
551 if ((bReturn
= WaitForTransmitSucceeded(output
->size(), output
->transmit_timeout
)) == false)
552 m_controller
->AddLog(CEC_LOG_DEBUG
, "did not receive ack");
561 void CCECProcessor::TransmitAbort(cec_logical_address address
, cec_opcode opcode
, cec_abort_reason reason
/* = CEC_ABORT_REASON_UNRECOGNIZED_OPCODE */)
563 m_controller
->AddLog(CEC_LOG_DEBUG
, "<< transmitting abort message");
567 cec_command::format(command
, m_logicalAddresses
.primary
, address
, CEC_OPCODE_FEATURE_ABORT
);
568 command
.parameters
.push_back((uint8_t)opcode
);
569 command
.parameters
.push_back((uint8_t)reason
);
574 bool CCECProcessor::WaitForTransmitSucceeded(uint8_t iLength
, uint32_t iTimeout
/* = 1000 */)
577 bool bTransmitSucceeded(false);
578 uint8_t iPacketsLeft(iLength
/ 4);
580 int64_t iNow
= GetTimeMs();
581 int64_t iTargetTime
= iNow
+ (uint64_t) iTimeout
;
583 while (!bTransmitSucceeded
&& !bError
&& (iTimeout
== 0 || iNow
< iTargetTime
))
585 CCECAdapterMessage msg
;
587 if (!m_communication
->Read(msg
, iTimeout
> 0 ? (int32_t)(iTargetTime
- iNow
) : 1000))
593 if ((bError
= msg
.is_error()) == false)
595 m_controller
->AddLog(bError
? CEC_LOG_WARNING
: CEC_LOG_DEBUG
, msg
.ToString());
597 switch(msg
.message())
599 case MSGCODE_COMMAND_ACCEPTED
:
600 if (iPacketsLeft
> 0)
603 case MSGCODE_TRANSMIT_SUCCEEDED
:
604 bTransmitSucceeded
= (iPacketsLeft
== 0);
605 bError
= !bTransmitSucceeded
;
608 if (ParseMessage(msg
))
609 m_commandBuffer
.Push(m_currentframe
);
616 return bTransmitSucceeded
&& !bError
;
619 bool CCECProcessor::ParseMessage(const CCECAdapterMessage
&msg
)
626 switch(msg
.message())
628 case MSGCODE_FRAME_START
:
630 m_currentframe
.clear();
633 m_currentframe
.initiator
= msg
.initiator();
634 m_currentframe
.destination
= msg
.destination();
635 m_currentframe
.ack
= msg
.ack();
636 m_currentframe
.eom
= msg
.eom();
640 case MSGCODE_FRAME_DATA
:
644 m_currentframe
.push_back(msg
[1]);
645 m_currentframe
.eom
= msg
.eom();
657 void CCECProcessor::ParseCommand(cec_command
&command
)
660 dataStr
.Format(">> %1x%1x:%02x", command
.initiator
, command
.destination
, command
.opcode
);
661 for (uint8_t iPtr
= 0; iPtr
< command
.parameters
.size
; iPtr
++)
662 dataStr
.AppendFormat(":%02x", (unsigned int)command
.parameters
[iPtr
]);
663 m_controller
->AddLog(CEC_LOG_TRAFFIC
, dataStr
.c_str());
666 m_busDevices
[(uint8_t)command
.initiator
]->HandleCommand(command
);
669 uint16_t CCECProcessor::GetPhysicalAddress(void) const
671 if (!m_logicalAddresses
.empty() && m_busDevices
[m_logicalAddresses
.primary
])
672 return m_busDevices
[m_logicalAddresses
.primary
]->GetPhysicalAddress();
676 void CCECProcessor::SetCurrentButton(cec_user_control_code iButtonCode
)
678 m_controller
->SetCurrentButton(iButtonCode
);
681 void CCECProcessor::AddCommand(const cec_command
&command
)
683 m_controller
->AddCommand(command
);
686 void CCECProcessor::AddKey(cec_keypress
&key
)
688 m_controller
->AddKey(key
);
691 void CCECProcessor::AddKey(void)
693 m_controller
->AddKey();
696 void CCECProcessor::AddLog(cec_log_level level
, const CStdString
&strMessage
)
698 m_controller
->AddLog(level
, strMessage
);
701 bool CCECProcessor::SetAckMask(uint16_t iMask
)
705 strLog
.Format("setting ackmask to %2x", iMask
);
706 m_controller
->AddLog(CEC_LOG_DEBUG
, strLog
.c_str());
708 CCECAdapterMessage
*output
= new CCECAdapterMessage
;
710 output
->push_back(MSGSTART
);
711 output
->push_escaped(MSGCODE_SET_ACK_MASK
);
712 output
->push_escaped(iMask
>> 8);
713 output
->push_escaped((uint8_t)iMask
);
714 output
->push_back(MSGEND
);
716 if ((bReturn
= Transmit(output
)) == false)
717 m_controller
->AddLog(CEC_LOG_ERROR
, "could not set the ackmask");