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 <msp/time/timer.h>
   9 #include <msp/time/units.h>
  10 #include "command.h"
  11 #include "control.h"
  12 #include "reply.h"
  13 #include "turnout.h"
  14
  15 using namespace std;
  16 using namespace Msp;
  17
  18 namespace Marklin {
  19
  20 Turnout::Turnout(Control &c, unsigned a, bool d):
  21         control(c),
  22         addr(a),
  23         route(0),
  24         dual(d)
  25 {
  26         control.add_turnout(*this);
  27
  28         control.signal_turnout_event.connect(sigc::mem_fun(this, &Turnout::turnout_event));
  29
  30         unsigned char data[2];
  31         data[0] = addr&0xFF;
  32         data[1] = (addr>>8)&0xFF;
  33         control.command(CMD_TURNOUT_STATUS, data, 2).signal_done.connect(sigc::bind(sigc::mem_fun(this, &Turnout::status_reply), false));
  34         if(dual)
  35         {
  36                 data[0] = (addr+1)&0xFF;
  37                 data[1] = ((addr+1)>>8)&0xFF;
  38                 control.command(CMD_TURNOUT_STATUS, data, 2).signal_done.connect(sigc::bind(sigc::mem_fun(this, &Turnout::status_reply), true));
  39         }
  40 }
  41
  42 void Turnout::set_route(unsigned r)
  43 {
  44         signal_route_changing.emit(r);
  45
  46         route = r;
  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