From: Mikko Rasa <tdb@tdb.fi>
Date: Wed, 11 Feb 2015 12:54:49 +0000 (+0200)
Subject: Add turnout failure simulation to the dummy driver
X-Git-Url: http://git.tdb.fi/?p=r2c2.git;a=commitdiff_plain;h=b3cc0d29a0fda2d48443d66881214c81a04b1729

Add turnout failure simulation to the dummy driver
---

diff --git a/source/libr2c2/dummy.cpp b/source/libr2c2/dummy.cpp
index a8efac3..0c3c351 100644
--- 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);
diff --git a/source/libr2c2/dummy.h b/source/libr2c2/dummy.h
index f7b48cf..547efc3 100644
--- a/source/libr2c2/dummy.h
+++ b/source/libr2c2/dummy.h
@@ -30,6 +30,7 @@ private:
 	std::map<unsigned, LocoState> locos;
 	std::map<unsigned, bool> sensors;
 	Msp::Time::TimeDelta turnout_delay;
+	int turnout_fail_rate;
 
 public:
 	Dummy(const Options &);