X-Git-Url: http://git.tdb.fi/?a=blobdiff_plain;f=source%2Flibr2c2%2Fsensor.cpp;h=ecd06473fb4bdf2234a2c149f19d0b3ae1af849e;hb=4acf89b0ec739c0bef8b11d3a52a4c551efa881e;hp=8a65d3dedf20f52419d130bfd1612f5bb3cc2a30;hpb=eb9c7f5200da4f3f31b41233be8cee397cb6abb9;p=r2c2.git diff --git a/source/libr2c2/sensor.cpp b/source/libr2c2/sensor.cpp index 8a65d3d..ecd0647 100644 --- a/source/libr2c2/sensor.cpp +++ b/source/libr2c2/sensor.cpp @@ -9,6 +9,8 @@ namespace R2C2 { Sensor::Sensor(Layout &l): layout(l), address(0), + id(0), + invert(false), state(INACTIVE) { if(layout.has_driver()) @@ -19,9 +21,23 @@ Sensor::Sensor(Layout &l): Sensor::~Sensor() { + if(layout.has_driver() && address) + layout.get_driver().remove_sensor(address); layout.remove(*this); } +void Sensor::set_address(unsigned a) +{ + Driver *driver = (layout.has_driver() ? &layout.get_driver() : 0); + if(driver && id) + driver->remove_sensor(id); + address = a; + if(driver && address) + id = driver->add_sensor(address); + else + id = 0; +} + void Sensor::tick(const Time::TimeDelta &dt) { if(state_confirm_timeout) @@ -39,17 +55,17 @@ void Sensor::tick(const Time::TimeDelta &dt) } } -void Sensor::event(unsigned a, bool s) +void Sensor::event(unsigned i, bool s) { - if(a==address) + if(i==id) { - if(s && stateMAYBE_INACTIVE) + else if(s==invert && state>MAYBE_INACTIVE) { state = MAYBE_INACTIVE; state_confirm_timeout = 700*Time::msec;