2013-11-05 16:46:17 +01:00
|
|
|
|
|
|
|
// STL includes
|
|
|
|
#include <cstring>
|
|
|
|
#include <cstdio>
|
|
|
|
#include <iostream>
|
|
|
|
|
|
|
|
// Local Hyperion includes
|
|
|
|
#include "LedRs232Device.h"
|
|
|
|
|
|
|
|
|
|
|
|
LedRs232Device::LedRs232Device(const std::string& outputDevice, const unsigned baudrate) :
|
|
|
|
mDeviceName(outputDevice),
|
|
|
|
mBaudRate_Hz(baudrate),
|
|
|
|
_rs232Port()
|
|
|
|
{
|
|
|
|
// empty
|
|
|
|
}
|
|
|
|
|
|
|
|
LedRs232Device::~LedRs232Device()
|
|
|
|
{
|
|
|
|
if (_rs232Port.isOpen())
|
|
|
|
{
|
|
|
|
_rs232Port.close();
|
|
|
|
}
|
|
|
|
}
|
|
|
|
|
|
|
|
int LedRs232Device::open()
|
|
|
|
{
|
|
|
|
try
|
|
|
|
{
|
|
|
|
_rs232Port.setPort(mDeviceName);
|
|
|
|
_rs232Port.setBaudrate(mBaudRate_Hz);
|
|
|
|
_rs232Port.open();
|
|
|
|
}
|
|
|
|
catch (const std::exception& e)
|
|
|
|
{
|
|
|
|
std::cerr << "Unable to open RS232 device (" << e.what() << ")" << std::endl;
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|
|
|
|
|
|
|
|
int LedRs232Device::writeBytes(const unsigned size, const uint8_t * data)
|
|
|
|
{
|
|
|
|
if (!_rs232Port.isOpen())
|
|
|
|
{
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
2013-11-11 21:07:24 +01:00
|
|
|
// for (int i = 0; i < 20; ++i)
|
|
|
|
// std::cout << std::hex << (int)data[i] << " ";
|
|
|
|
// std::cout << std::endl;
|
2013-11-05 21:32:21 +01:00
|
|
|
|
2013-11-05 16:46:17 +01:00
|
|
|
try
|
|
|
|
{
|
|
|
|
_rs232Port.write(data, size);
|
|
|
|
}
|
|
|
|
catch (const std::exception& e)
|
|
|
|
{
|
|
|
|
std::cerr << "Unable to write to RS232 device (" << e.what() << ")" << std::endl;
|
|
|
|
return -1;
|
|
|
|
}
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
}
|