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 "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):
  22         control(c),
  23         addr(a),
  24         route(0)
  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::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         unsigned char data[2];
  49         data[0]=addr&0xFF;
  50         data[1]=((addr>>8)&0x7) | (on ? 0x40 : 0) | (route==0 ? 0x80 : 0);
  51         control.command(CMD_TURNOUT, data, 2);
  52 }
  53
  54 void Turnout::status_reply(const Reply &reply)
  55 {
  56         if(reply.get_error()==ERR_NO_ERROR)
  57         {
  58                 route=(reply.get_data()[0]&0x04) ? 0 : 1;
  59                 signal_route_changed.emit(route);
  60         }
  61 }
  62
  63 bool Turnout::switch_timeout()
  64 {
  65         command(false);
  66
  67         return false;
  68 }
  69
  70 void Turnout::turnout_event(unsigned a, bool r)
  71 {
  72         if(a==addr && r!=route)
  73         {
  74                 route=r;
  75                 signal_route_changed.emit(route);
  76         }
  77 }
  78
  79 } // namespace Marklin