3 This file is part of the MSP Märklin suite
4 Copyright © 2006-2009 Mikkosoft Productions, Mikko Rasa
5 Distributed under the GPL
8 #include <msp/time/timer.h>
9 #include <msp/time/units.h>
11 #include "constants.h"
13 #include "locomotive.h"
21 Locomotive::Locomotive(const LocoType &t, Control &c, unsigned a):
29 control.add_locomotive(*this);
34 void Locomotive::set_speed(unsigned spd)
37 signal_speed_changing.emit(spd);
42 signal_speed_changed.emit(speed);
45 void Locomotive::set_reverse(bool rev)
52 control.set_timer((500+speed*150)*Time::msec).signal_timeout.connect(sigc::mem_fun(this, &Locomotive::reverse_timeout));
59 signal_reverse_changed.emit(reverse);
63 void Locomotive::set_function(unsigned func, bool state)
72 signal_function_changed.emit(func, state);
75 void Locomotive::refresh_status()
77 unsigned char data[2];
79 data[1] = (addr>>8)&0xFF;
80 control.command(CMD_LOK_STATUS, data, 2).signal_done.connect(sigc::mem_fun(this, &Locomotive::status_reply));
83 void Locomotive::send_command(bool setf)
85 unsigned char data[4];
87 data[1] = (addr>>8)&0xFF;
94 data[2] = (speed*19-18)/2;
96 data[3] = (reverse ? 0 : 0x20) | ((funcs&1) ? 0x10 : 0);
101 for(unsigned i=0; i<4; ++i)
105 control.command(CMD_LOK, data, 4);
108 void Locomotive::status_reply(const Reply &reply)
110 if(reply.get_error()==ERR_NO_ERROR)
112 const unsigned char *data = reply.get_data();
117 speed = data[0]*2/19+1;
119 reverse = (data[1]&0x20) ? false : true;
120 funcs = (data[1]&0xF)<<1;
124 for(unsigned i=0; i<5; ++i)
125 signal_function_changed.emit(i, (funcs>>i)&1);
129 bool Locomotive::reverse_timeout()
133 signal_reverse_changed.emit(reverse);
137 } // namespace Marklin