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"
42 CAdapterCommunication::CAdapterCommunication(CLibCEC
*controller
) :
44 m_controller(controller
),
49 m_port
= new CSerialPort
;
52 CAdapterCommunication::~CAdapterCommunication(void)
66 bool CAdapterCommunication::Open(const char *strPort
, uint16_t iBaudRate
/* = 38400 */, uint32_t iTimeoutMs
/* = 10000 */)
68 CLockObject
lock(&m_commMutex
);
71 m_controller
->AddLog(CEC_LOG_ERROR
, "port is NULL");
77 m_controller
->AddLog(CEC_LOG_ERROR
, "port is already open");
80 if (!m_port
->Open(strPort
, iBaudRate
))
83 strError
.Format("error opening serial port '%s': %s", strPort
, m_port
->GetError().c_str());
84 m_controller
->AddLog(CEC_LOG_ERROR
, strError
);
88 m_controller
->AddLog(CEC_LOG_DEBUG
, "connection opened");
90 //clear any input bytes
92 m_port
->Read(buff
, sizeof(buff
), 50);
94 Sleep(CEC_SETTLE_DOWN_TIME
);
98 m_controller
->AddLog(CEC_LOG_DEBUG
, "communication thread created");
103 m_controller
->AddLog(CEC_LOG_DEBUG
, "could not create a communication thread");
109 void CAdapterCommunication::Close(void)
111 CLockObject
lock(&m_commMutex
);
122 m_rcvCondition
.Broadcast();
125 void *CAdapterCommunication::Process(void)
127 m_controller
->AddLog(CEC_LOG_DEBUG
, "communication thread started");
132 CLockObject
lock(&m_commMutex
);
143 bool CAdapterCommunication::ReadFromDevice(uint32_t iTimeout
)
150 iBytesRead
= m_port
->Read(buff
, sizeof(buff
), iTimeout
);
151 if (iBytesRead
< 0 || iBytesRead
> 256)
154 strError
.Format("error reading from serial port: %s", m_port
->GetError().c_str());
155 m_controller
->AddLog(CEC_LOG_ERROR
, strError
);
158 else if (iBytesRead
> 0)
159 AddData(buff
, (uint8_t) iBytesRead
);
161 return iBytesRead
> 0;
164 void CAdapterCommunication::AddData(uint8_t *data
, uint8_t iLen
)
166 CLockObject
lock(&m_bufferMutex
);
167 if (m_iInbufUsed
+ iLen
> m_iInbufSize
)
169 m_iInbufSize
= m_iInbufUsed
+ iLen
;
170 m_inbuf
= (uint8_t*)realloc(m_inbuf
, m_iInbufSize
);
173 memcpy(m_inbuf
+ m_iInbufUsed
, data
, iLen
);
174 m_iInbufUsed
+= iLen
;
176 m_rcvCondition
.Signal();
179 bool CAdapterCommunication::Write(const cec_adapter_message
&data
)
181 CLockObject
lock(&m_commMutex
);
182 if (m_port
->Write(data
) != (int32_t) data
.size())
185 strError
.Format("error writing to serial port: %s", m_port
->GetError().c_str());
186 m_controller
->AddLog(CEC_LOG_ERROR
, strError
);
190 m_controller
->AddLog(CEC_LOG_DEBUG
, "command sent");
191 CCondition::Sleep((uint32_t) data
.size() * (uint32_t)24 /*data*/ + (uint32_t)5 /*start bit (4.5 ms)*/);
196 bool CAdapterCommunication::Read(cec_adapter_message
&msg
, uint32_t iTimeout
)
198 CLockObject
lock(&m_bufferMutex
);
200 if (m_iInbufUsed
< 1)
202 if (!m_rcvCondition
.Wait(&m_bufferMutex
, iTimeout
))
206 if (m_iInbufUsed
< 1 || IsStopped())
209 //search for first start of message
210 int16_t startpos
= -1;
211 for (int16_t iPtr
= 0; iPtr
< m_iInbufUsed
; iPtr
++)
213 if (m_inbuf
[iPtr
] == MSGSTART
)
223 //move anything from the first start of message to the beginning of the buffer
226 memmove(m_inbuf
, m_inbuf
+ startpos
, m_iInbufUsed
- startpos
);
227 m_iInbufUsed
-= startpos
;
230 if (m_iInbufUsed
< 2)
233 //look for end of message
236 for (int16_t iPtr
= 1; iPtr
< m_iInbufUsed
; iPtr
++)
238 if (m_inbuf
[iPtr
] == MSGEND
)
243 else if (m_inbuf
[iPtr
] == MSGSTART
)
250 if (startpos
> 0) //we found a msgstart before msgend, this is not right, remove
252 m_controller
->AddLog(CEC_LOG_ERROR
, "received MSGSTART before MSGEND");
253 memmove(m_inbuf
, m_inbuf
+ startpos
, m_iInbufUsed
- startpos
);
254 m_iInbufUsed
-= startpos
;
258 if (endpos
> 0) //found a MSGEND
262 for (int16_t iPtr
= 1; iPtr
< endpos
; iPtr
++)
266 msg
.push_back(m_inbuf
[iPtr
] + (uint8_t)ESCOFFSET
);
269 else if (m_inbuf
[iPtr
] == MSGESC
)
275 msg
.push_back(m_inbuf
[iPtr
]);
279 if (endpos
+ 1 < m_iInbufUsed
)
280 memmove(m_inbuf
, m_inbuf
+ endpos
+ 1, m_iInbufUsed
- endpos
- 1);
282 m_iInbufUsed
-= endpos
+ 1;
290 std::string
CAdapterCommunication::GetError(void) const
292 return m_port
->GetError();
295 bool CAdapterCommunication::StartBootloader(void)
300 m_controller
->AddLog(CEC_LOG_DEBUG
, "starting the bootloader");
301 cec_adapter_message output
;
304 output
.push_back(MSGSTART
);
305 PushEscaped(output
, MSGCODE_START_BOOTLOADER
);
306 output
.push_back(MSGEND
);
310 m_controller
->AddLog(CEC_LOG_ERROR
, "could not start the bootloader");
313 m_controller
->AddLog(CEC_LOG_DEBUG
, "bootloader start command transmitted");
317 void CAdapterCommunication::PushEscaped(cec_adapter_message
&vec
, uint8_t byte
)
319 if (byte
>= MSGESC
&& byte
!= MSGSTART
)
321 vec
.push_back(MSGESC
);
322 vec
.push_back(byte
- ESCOFFSET
);
330 bool CAdapterCommunication::SetAckMask(uint16_t iMask
)
336 strLog
.Format("setting ackmask to %2x", iMask
);
337 m_controller
->AddLog(CEC_LOG_DEBUG
, strLog
.c_str());
339 cec_adapter_message output
;
342 output
.push_back(MSGSTART
);
343 PushEscaped(output
, MSGCODE_SET_ACK_MASK
);
344 PushEscaped(output
, iMask
>> 8);
345 PushEscaped(output
, (uint8_t)iMask
);
346 output
.push_back(MSGEND
);
350 m_controller
->AddLog(CEC_LOG_ERROR
, "could not set the ackmask");
357 bool CAdapterCommunication::PingAdapter(void)
362 m_controller
->AddLog(CEC_LOG_DEBUG
, "sending ping");
363 cec_adapter_message output
;
366 output
.push_back(MSGSTART
);
367 PushEscaped(output
, MSGCODE_PING
);
368 output
.push_back(MSGEND
);
372 m_controller
->AddLog(CEC_LOG_ERROR
, "could not send ping command");
376 m_controller
->AddLog(CEC_LOG_DEBUG
, "ping tranmitted");
378 // TODO check for pong
382 bool CAdapterCommunication::IsOpen(void) const
384 return !IsStopped() && m_port
->IsOpen();
387 void CAdapterCommunication::FormatAdapterMessage(const cec_command
&command
, cec_adapter_message
&packet
)
391 //set ack polarity to high when transmitting to the broadcast address
392 //set ack polarity low when transmitting to any other address
393 packet
.push_back(MSGSTART
);
394 PushEscaped(packet
, MSGCODE_TRANSMIT_ACK_POLARITY
);
395 if (command
.destination
== CECDEVICE_BROADCAST
)
396 PushEscaped(packet
, CEC_TRUE
);
398 PushEscaped(packet
, CEC_FALSE
);
399 packet
.push_back(MSGEND
);
401 // add source and destination
402 packet
.push_back(MSGSTART
);
403 PushEscaped(packet
, MSGCODE_TRANSMIT
);
404 packet
.push_back(((uint8_t)command
.initiator
<< 4) + (uint8_t)command
.destination
);
405 packet
.push_back(MSGEND
);
408 packet
.push_back(MSGSTART
);
409 PushEscaped(packet
, command
.parameters
.empty() ? (uint8_t)MSGCODE_TRANSMIT_EOM
: (uint8_t)MSGCODE_TRANSMIT
);
410 packet
.push_back((uint8_t) command
.opcode
);
411 packet
.push_back(MSGEND
);
414 for (int8_t iPtr
= 0; iPtr
< command
.parameters
.size
; iPtr
++)
416 packet
.push_back(MSGSTART
);
418 if (iPtr
== command
.parameters
.size
- 1)
419 PushEscaped(packet
, MSGCODE_TRANSMIT_EOM
);
421 PushEscaped(packet
, MSGCODE_TRANSMIT
);
423 PushEscaped(packet
, command
.parameters
[iPtr
]);
425 packet
.push_back(MSGEND
);