source/libmarklin/turnout.cpp

   1 /* $Id$
   2
   3 This file is part of the MSP Märklin suite
   4 Copyright © 2006-2008 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 "turnout.h"
  14
  15 using namespace std;
  16 using namespace Msp;
  17
  18 namespace Marklin {
  19
  20 Turnout::Turnout(Control &c, unsigned a):
  21         control(c),
  22         addr(a),
  23         route(0)
  24 {
  25         control.add_turnout(*this);
  26
  27         control.signal_turnout_event.connect(sigc::mem_fun(this, &Turnout::turnout_event));
  28
  29         char cmd[3];
  30         cmd[0]=CMD_TURNOUT_STATUS;
  31         cmd[1]=addr&0xFF;
  32         cmd[2]=(addr>>8)&0xFF;
  33         control.command(string(cmd, 3)).signal_done.connect(sigc::mem_fun(this, &Turnout::status_reply));
  34 }
  35
  36 void Turnout::set_route(unsigned r)
  37 {
  38         route=r;
  39
  40         command(true);
  41         control.set_timer(200*Time::msec).signal_timeout.connect(sigc::mem_fun(this, &Turnout::switch_timeout));
  42
  43         signal_route_changed.emit(route);
  44 }
  45
  46 void Turnout::command(bool on)
  47 {
  48         char cmd[3];
  49         cmd[0]=CMD_TURNOUT;
  50         cmd[1]=addr&0xFF;
  51         cmd[2]=((addr>>8)&0x7);
  52         if(on)
  53                 cmd[2]|=0x40;
  54         if(route==0)
  55                 cmd[2]|=0x80;
  56         control.command(string(cmd, 3));
  57 }
  58
  59 void Turnout::status_reply(Error err, const string &reply)
  60 {
  61         if(err==ERR_NO_ERROR)
  62         {
  63                 route=(reply[0]&4)?0:1;
  64                 signal_route_changed.emit(route);
  65         }
  66 }
  67
  68 bool Turnout::switch_timeout()
  69 {
  70         command(false);
  71
  72         return false;
  73 }
  74
  75 void Turnout::turnout_event(unsigned a, bool r)
  76 {
  77         if(a==addr && r!=route)
  78         {
  79                 route=r;
  80                 signal_route_changed.emit(route);
  81         }
  82 }
  83
  84 } // namespace Marklin