source/libr2c2/sensor.cpp

   1 #include "driver.h"
   2 #include "layout.h"
   3 #include "sensor.h"
   4
   5 using namespace Msp;
   6
   7 namespace R2C2 {
   8
   9 Sensor::Sensor(Layout &l):
  10         layout(l),
  11         address(0),
  12         invert(false),
  13         state(INACTIVE)
  14 {
  15         if(layout.has_driver())
  16                 layout.get_driver().signal_sensor.connect(sigc::mem_fun(this, &Sensor::event));
  17
  18         layout.add(*this);
  19 }
  20
  21 Sensor::~Sensor()
  22 {
  23         layout.remove(*this);
  24 }
  25
  26 void Sensor::set_address(unsigned a)
  27 {
  28         address = a;
  29         if(layout.has_driver())
  30                 layout.get_driver().add_sensor(address);
  31 }
  32
  33 void Sensor::tick(const Time::TimeDelta &dt)
  34 {
  35         if(state_confirm_timeout)
  36         {
  37                 state_confirm_timeout -= dt;
  38                 if(state_confirm_timeout<=Time::zero)
  39                 {
  40                         if(state==MAYBE_INACTIVE)
  41                                 state = INACTIVE;
  42                         else if(state==MAYBE_ACTIVE)
  43                                 state = ACTIVE;
  44                         state_confirm_timeout = Time::zero;
  45                         signal_state_changed.emit(state);
  46                 }
  47         }
  48 }
  49
  50 void Sensor::event(unsigned a, bool s)
  51 {
  52         if(a==address)
  53         {
  54                 if(s!=invert && state<MAYBE_ACTIVE)
  55                 {
  56                         state = MAYBE_ACTIVE;
  57                         state_confirm_timeout = 300*Time::msec;
  58                         signal_state_changed.emit(state);
  59                 }
  60                 else if(s==invert && state>MAYBE_INACTIVE)
  61                 {
  62                         state = MAYBE_INACTIVE;
  63                         state_confirm_timeout = 700*Time::msec;
  64                         signal_state_changed.emit(state);
  65                 }
  66         }
  67 }
  68
  69 } // namespace R2C2