3 This file is part of the MSP Märklin suite
4 Copyright © 2006-2008 Mikkosoft Productions, Mikko Rasa
5 Distributed under the GPL
9 #include <msp/time/timer.h>
10 #include <msp/time/units.h>
21 Turnout::Turnout(Control &c, unsigned a):
26 control.add_turnout(*this);
28 control.signal_turnout_event.connect(sigc::mem_fun(this, &Turnout::turnout_event));
30 unsigned char data[2];
32 data[1]=(addr>>8)&0xFF;
33 control.command(CMD_TURNOUT_STATUS, data, 2).signal_done.connect(sigc::mem_fun(this, &Turnout::status_reply));
36 void Turnout::set_route(unsigned r)
41 control.set_timer(200*Time::msec).signal_timeout.connect(sigc::mem_fun(this, &Turnout::switch_timeout));
43 signal_route_changed.emit(route);
46 void Turnout::command(bool on)
48 unsigned char data[2];
50 data[1]=((addr>>8)&0x7) | (on ? 0x40 : 0) | (route==0 ? 0x80 : 0);
51 control.command(CMD_TURNOUT, data, 2);
54 void Turnout::status_reply(const Reply &reply)
56 if(reply.get_error()==ERR_NO_ERROR)
58 route=(reply.get_data()[0]&0x04) ? 0 : 1;
59 signal_route_changed.emit(route);
63 bool Turnout::switch_timeout()
70 void Turnout::turnout_event(unsigned a, bool r)
72 if(a==addr && r!=route)
75 signal_route_changed.emit(route);
79 } // namespace Marklin