]> git.tdb.fi Git - r2c2.git/blob - source/libmarklin/turnout.cpp
Allow setting sensor ID for multiple tracks at once
[r2c2.git] / source / libmarklin / turnout.cpp
1 /* $Id$
2
3 This file is part of the MSP Märklin suite
4 Copyright © 2006-2009 Mikkosoft Productions, Mikko Rasa
5 Distributed under the GPL
6 */
7
8 #include <iostream>
9 #include <msp/time/timer.h>
10 #include <msp/time/units.h>
11 #include "command.h"
12 #include "control.h"
13 #include "reply.h"
14 #include "turnout.h"
15
16 using namespace std;
17 using namespace Msp;
18
19 namespace Marklin {
20
21 Turnout::Turnout(Control &c, unsigned a, bool d):
22         control(c),
23         addr(a),
24         route(0),
25         dual(d)
26 {
27         control.add_turnout(*this);
28
29         control.signal_turnout_event.connect(sigc::mem_fun(this, &Turnout::turnout_event));
30
31         unsigned char data[2];
32         data[0]=addr&0xFF;
33         data[1]=(addr>>8)&0xFF;
34         control.command(CMD_TURNOUT_STATUS, data, 2).signal_done.connect(sigc::bind(sigc::mem_fun(this, &Turnout::status_reply), false));
35         if(dual)
36         {
37                 data[0]=(addr+1)&0xFF;
38                 data[1]=((addr+1)>>8)&0xFF;
39                 control.command(CMD_TURNOUT_STATUS, data, 2).signal_done.connect(sigc::bind(sigc::mem_fun(this, &Turnout::status_reply), true));
40         }
41 }
42
43 void Turnout::set_route(unsigned r)
44 {
45         route=r;
46
47         command(true);
48         control.set_timer(200*Time::msec).signal_timeout.connect(sigc::mem_fun(this, &Turnout::switch_timeout));
49
50         signal_route_changed.emit(route);
51 }
52
53 void Turnout::command(bool on)
54 {
55         unsigned char data[2];
56         data[0]=addr&0xFF;
57         data[1]=((addr>>8)&0x7) | (on ? 0x40 : 0) | (route&1 ? 0 : 0x80);
58         control.command(CMD_TURNOUT, data, 2);
59         if(dual)
60         {
61                 data[0]=(addr+1)&0xFF;
62                 data[1]=(((addr+1)>>8)&0x7) | (on ? 0x40 : 0) | (route&2 ? 0 : 0x80);
63                 control.command(CMD_TURNOUT, data, 2);
64         }
65 }
66
67 void Turnout::status_reply(const Reply &reply, bool high)
68 {
69         if(reply.get_error()==ERR_NO_ERROR)
70         {
71                 bool v=!(reply.get_data()[0]&0x04);
72                 unsigned b=(high?2:1);
73                 route=(route&~b)|(v?b:0);
74                 signal_route_changed.emit(route);
75         }
76 }
77
78 bool Turnout::switch_timeout()
79 {
80         command(false);
81
82         return false;
83 }
84
85 void Turnout::turnout_event(unsigned a, bool r)
86 {
87         if(a==addr && r!=(route&1))
88         {
89                 route=(route&2)|(r?1:0);
90                 signal_route_changed.emit(route);
91         }
92         else if(dual && a==addr+1 && r!=((route>>1)&1))
93         {
94                 route=(route&1)|(r?2:0);
95                 signal_route_changed.emit(route);
96         }
97 }
98
99 } // namespace Marklin