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 "AdapterCommunication.h"
36 #include "platform/serialport.h"
37 #include "util/StdString.h"
38 #include "platform/timeutils.h"
43 CAdapterCommunication::CAdapterCommunication(CLibCEC
*controller
) :
45 m_controller(controller
)
47 m_port
= new CSerialPort
;
50 CAdapterCommunication::~CAdapterCommunication(void)
61 bool CAdapterCommunication::Open(const char *strPort
, uint16_t iBaudRate
/* = 38400 */, uint32_t iTimeoutMs
/* = 10000 */)
63 CLockObject
lock(&m_commMutex
);
66 m_controller
->AddLog(CEC_LOG_ERROR
, "port is NULL");
72 m_controller
->AddLog(CEC_LOG_ERROR
, "port is already open");
75 if (!m_port
->Open(strPort
, iBaudRate
))
78 strError
.Format("error opening serial port '%s': %s", strPort
, m_port
->GetError().c_str());
79 m_controller
->AddLog(CEC_LOG_ERROR
, strError
);
83 m_controller
->AddLog(CEC_LOG_DEBUG
, "connection opened");
85 //clear any input bytes
87 m_port
->Read(buff
, sizeof(buff
), 500);
91 m_controller
->AddLog(CEC_LOG_DEBUG
, "communication thread created");
96 m_controller
->AddLog(CEC_LOG_DEBUG
, "could not create a communication thread");
102 void CAdapterCommunication::Close(void)
104 CLockObject
lock(&m_commMutex
);
107 m_rcvCondition
.Broadcast();
110 void *CAdapterCommunication::Process(void)
112 m_controller
->AddLog(CEC_LOG_DEBUG
, "communication thread started");
124 bool CAdapterCommunication::ReadFromDevice(uint32_t iTimeout
)
126 CLockObject
lock(&m_commMutex
);
132 iBytesRead
= m_port
->Read(buff
, sizeof(buff
), iTimeout
);
133 if (iBytesRead
< 0 || iBytesRead
> 256)
136 strError
.Format("error reading from serial port: %s", m_port
->GetError().c_str());
137 m_controller
->AddLog(CEC_LOG_ERROR
, strError
);
140 else if (iBytesRead
> 0)
141 AddData(buff
, (uint8_t) iBytesRead
);
143 return iBytesRead
> 0;
146 void CAdapterCommunication::AddData(uint8_t *data
, uint8_t iLen
)
148 CLockObject
lock(&m_bufferMutex
);
149 for (unsigned int iPtr
= 0; iPtr
< iLen
; iPtr
++)
150 m_inBuffer
.Push(data
[iPtr
]);
152 m_rcvCondition
.Signal();
155 void CAdapterCommunication::WriteNextCommand(void)
157 CLockObject
lock(&m_commMutex
);
158 CCECAdapterMessage msg
;
159 if (m_outBuffer
.Pop(msg
))
161 if (m_port
->Write(msg
) != (int32_t) msg
.size())
164 strError
.Format("error writing to serial port: %s", m_port
->GetError().c_str());
165 m_controller
->AddLog(CEC_LOG_ERROR
, strError
);
169 m_controller
->AddLog(CEC_LOG_DEBUG
, "command sent");
170 CCondition::Sleep((uint32_t) msg
.size() * (uint32_t)24 /*data*/ + (uint32_t)5 /*start bit (4.5 ms)*/);
175 bool CAdapterCommunication::Write(const CCECAdapterMessage
&data
)
177 m_outBuffer
.Push(data
);
181 bool CAdapterCommunication::Read(CCECAdapterMessage
&msg
, uint32_t iTimeout
)
183 CLockObject
lock(&m_bufferMutex
);
186 uint64_t iNow
= GetTimeMs();
187 uint64_t iTarget
= iNow
+ iTimeout
;
188 bool bGotFullMessage(false);
189 bool bNextIsEscaped(false);
190 bool bGotStart(false);
192 while(!bGotFullMessage
&& iNow
< iTarget
)
195 if (!m_inBuffer
.Pop(buf
))
197 if (!m_rcvCondition
.Wait(&m_bufferMutex
, iTarget
- iNow
))
207 else if (buf
== MSGSTART
) //we found a msgstart before msgend, this is not right, remove
209 m_controller
->AddLog(CEC_LOG_ERROR
, "received MSGSTART before MSGEND");
216 bGotFullMessage
= true;
218 else if (bNextIsEscaped
)
220 msg
.push_back(buf
+ (uint8_t)ESCOFFSET
);
221 bNextIsEscaped
= false;
223 else if (buf
== MSGESC
)
224 bNextIsEscaped
= true;
229 return bGotFullMessage
;
232 std::string
CAdapterCommunication::GetError(void) const
234 return m_port
->GetError();
237 bool CAdapterCommunication::StartBootloader(void)
242 m_controller
->AddLog(CEC_LOG_DEBUG
, "starting the bootloader");
243 CCECAdapterMessage output
;
245 output
.push_back(MSGSTART
);
246 output
.push_escaped(MSGCODE_START_BOOTLOADER
);
247 output
.push_back(MSGEND
);
251 m_controller
->AddLog(CEC_LOG_ERROR
, "could not start the bootloader");
254 m_controller
->AddLog(CEC_LOG_DEBUG
, "bootloader start command transmitted");
258 bool CAdapterCommunication::SetAckMask(uint16_t iMask
)
264 strLog
.Format("setting ackmask to %2x", iMask
);
265 m_controller
->AddLog(CEC_LOG_DEBUG
, strLog
.c_str());
267 CCECAdapterMessage output
;
269 output
.push_back(MSGSTART
);
270 output
.push_escaped(MSGCODE_SET_ACK_MASK
);
271 output
.push_escaped(iMask
>> 8);
272 output
.push_escaped((uint8_t)iMask
);
273 output
.push_back(MSGEND
);
277 m_controller
->AddLog(CEC_LOG_ERROR
, "could not set the ackmask");
284 bool CAdapterCommunication::PingAdapter(void)
289 m_controller
->AddLog(CEC_LOG_DEBUG
, "sending ping");
290 CCECAdapterMessage output
;
292 output
.push_back(MSGSTART
);
293 output
.push_escaped(MSGCODE_PING
);
294 output
.push_back(MSGEND
);
298 m_controller
->AddLog(CEC_LOG_ERROR
, "could not send ping command");
302 m_controller
->AddLog(CEC_LOG_DEBUG
, "ping tranmitted");
304 // TODO check for pong
308 bool CAdapterCommunication::IsOpen(void) const
310 return !IsStopped() && m_port
->IsOpen();