Add turnout failure simulation to the dummy driver

[r2c2.git] / source / libr2c2 / dummy.cpp

diff --git a/source/libr2c2/dummy.cpp b/source/libr2c2/dummy.cpp
index a8efac3a1d71204f3b0d861843b482db41911f98..0c3c351d968d01b23a79597aa4e725791dea5d62 100644 (file)
--- a/source/libr2c2/dummy.cpp
+++ b/source/libr2c2/dummy.cpp
@@ -1,3 +1,4 @@
+#include <cstdlib>
 #include <msp/strings/utils.h>
 #include <msp/time/utils.h>
 #include "dummy.h"
@@ -9,7 +10,8 @@ namespace R2C2 {
 
 Dummy::Dummy(const Options &opts):
        power(true),
-       turnout_delay(opts.get("turnout_delay", 0.0f)*Time::sec)
+       turnout_delay(opts.get("turnout_delay", 0.0f)*Time::sec),
+       turnout_fail_rate(opts.get("turnout_fail_rate", 0.0f)*RAND_MAX)
 { }
 
 void Dummy::set_power(bool p)
@@ -62,7 +64,8 @@ void Dummy::set_turnout(unsigned addr, unsigned state)
                turnout.timeout = Time::now()+turnout_delay;
        else
        {
-               turnout.state = state;
+               if(!turnout_fail_rate || rand()>=turnout_fail_rate)
+                       turnout.state = state;
                signal_turnout.emit(addr, state);
        }
 }
@@ -121,6 +124,11 @@ void Dummy::tick()
        {
                if(i->second.timeout && t>=i->second.timeout)
                {
+                       if(turnout_fail_rate && rand()<turnout_fail_rate)
+                       {
+                               signal_turnout_failed.emit(i->first);
+                               i->second.pending = i->second.state;
+                       }
                        i->second.state = i->second.pending;
                        i->second.timeout = Time::TimeStamp();
                        signal_turnout.emit(i->first, i->second.state);