-/* $Id$
-
-This file is part of R²C²
-Copyright © 2010 Mikkosoft Productions, Mikko Rasa
-Distributed under the GPL
-*/
-
#include <fcntl.h>
#include <termios.h>
#include <sys/poll.h>
namespace R2C2 {
Intellibox::Intellibox(const string &dev):
+ serial(dev),
power(false),
halted(false),
update_sensors(false),
command_sent(false)
{
- serial_fd = ::open(dev.c_str(), O_RDWR);
- if(serial_fd<0)
- throw Exception("Couldn't open serial port\n");
+ static unsigned baud[]= { 2400, 4800, 9600, 19200, 0 };
- static unsigned baud[]=
- {
- 2400, B2400,
- 4800, B4800,
- 9600, B9600,
- 19200, B19200,
- 0
- };
-
- termios attr;
- tcgetattr(serial_fd, &attr);
- cfmakeraw(&attr);
- attr.c_cflag |= CSTOPB;
+ serial.set_stop_bits(2);
bool ok = false;
bool p50 = false;
- for(unsigned i=0; baud[i]; i+=2)
+ for(unsigned i=0; baud[i]; ++i)
{
- cfsetospeed(&attr, baud[i+1]);
- tcsetattr(serial_fd, TCSADRAIN, &attr);
+ serial.set_baud_rate(baud[i]);
+ serial.put('\xC4');
- write(serial_fd, "\xC4", 1);
-
- pollfd pfd = { serial_fd, POLLIN, 0 };
- if(poll(&pfd, 1, 500)>0)
+ if(IO::poll(serial, IO::P_INPUT, 500*Time::msec))
{
IO::print("IB detected at %d bits/s\n", baud[i]);
char buf[2];
- p50 = (read(serial_fd, buf, 2)==2);
+ p50 = (serial.read(buf, 2)==2);
ok = true;
break;
}
}
if(!ok)
- throw Exception("IB not detected");
+ throw runtime_error("IB not detected");
if(p50)
- write(serial_fd, "xZzA1\r", 6);
+ serial.write("xZzA1\r", 6);
command(CMD_STATUS);
}
if(!queue.empty() && command_sent)
{
- pollfd pfd = { serial_fd, POLLIN, 0 };
- if(poll(&pfd, 1, 0)>0)
+ if(IO::poll(serial, IO::P_INPUT, Time::zero))
{
process_reply(t);
queue.erase(queue.begin());
if(!queue.empty())
{
const CommandSlot &slot = queue.front();
- write(serial_fd, slot.data, slot.length);
+ serial.write(reinterpret_cast<const char *>(slot.data), slot.length);
command_sent = true;
}
}
void Intellibox::flush()
{
- Time::TimeStamp t = Time::now();
for(list<CommandSlot>::iterator i=queue.begin(); i!=queue.end(); ++i)
{
- write(serial_fd, i->data, i->length);
- pollfd pfd = { serial_fd, POLLIN, 0 };
+ serial.write(reinterpret_cast<const char *>(i->data), i->length);
bool first = true;
- while(poll(&pfd, 1, (first ? -1 : 0))>0)
+ while(first ? IO::poll(serial, IO::P_INPUT) : IO::poll(serial, IO::P_INPUT, Time::zero))
{
char data[16];
- read(serial_fd, data, 16);
+ serial.read(data, 16);
first = false;
}
}
else if(name=="MM-27")
return MM_27;
else
- throw InvalidParameterValue("Unknown protocol");
+ throw invalid_argument("Intellibox::map_protocol");
}
void Intellibox::command(Command cmd)
unsigned speed = (data[0]<=1 ? 0 : data[0]*2/19+1);
bool reverse = !(data[1]&0x20);
- if(speed!=loco.speed || reverse!=loco.reverse)
- {
- loco.speed = speed;
- loco.reverse = reverse;
- signal_loco_speed.emit(addr, loco.speed, loco.reverse);
- }
+ bool speed_changed = (speed!=loco.speed || reverse!=loco.reverse);
+
+ loco.speed = speed;
+ loco.reverse = reverse;
unsigned funcs = (data[1]&0xF)<<1;
if(data[1]&0x10)
funcs |= 1;
- if(funcs!=loco.funcs)
- {
- unsigned changed = loco.funcs^funcs;
- loco.funcs = funcs;
- for(unsigned i=0; i<5; ++i)
- if(changed&(1<<i))
- signal_loco_function.emit(addr, i, loco.funcs&(1<<i));
- }
+ unsigned funcs_changed = loco.funcs^funcs;
+ loco.funcs = funcs;
+
+ if(speed_changed)
+ signal_loco_speed.emit(addr, loco.speed, loco.reverse);
+ for(unsigned i=0; i<5; ++i)
+ if(funcs_changed&(1<<i))
+ signal_loco_function.emit(addr, i, loco.funcs&(1<<i));
}
else
error(cmd, err);
{
unsigned pos = 0;
while(pos<len)
- pos += read(serial_fd, buf+pos, len-pos);
+ pos += serial.read(reinterpret_cast<char *>(buf+pos), len-pos);
return pos;
}