X-Git-Url: http://git.tdb.fi/?a=blobdiff_plain;f=source%2Flibr2c2%2Fdummy.cpp;h=90638f63bd8c438b2cfa845a7c0d20173992df41;hb=9f0d428e974defa64cdf8e7b7072967327250958;hp=cfee07417b3105b75c2eba5a1029f3056ead320a;hpb=2c08ce7d004b20a1cd9bc68fccbf734a6ba2d242;p=r2c2.git

diff --git a/source/libr2c2/dummy.cpp b/source/libr2c2/dummy.cpp
index cfee074..90638f6 100644
--- a/source/libr2c2/dummy.cpp
+++ b/source/libr2c2/dummy.cpp
@@ -1,3 +1,5 @@
+#include <cstdlib>
+#include <msp/core/maputils.h>
 #include <msp/strings/utils.h>
 #include <msp/time/utils.h>
 #include "dummy.h"
@@ -9,7 +11,9 @@ namespace R2C2 {
 
 Dummy::Dummy(const Options &opts):
 	power(true),
-	turnout_delay(opts.get("turnout_delay", 0U)*Time::sec)
+	halted(false),
+	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)
@@ -18,6 +22,18 @@ void Dummy::set_power(bool p)
 	signal_power.emit(power);
 }
 
+void Dummy::halt(bool h)
+{
+	halted = h;
+	if(halted)
+	{
+		for(map<unsigned, LocoState>::iterator i=locos.begin(); i!=locos.end(); ++i)
+			if(i->second.speed)
+				set_loco_speed(i->first, 0);
+	}
+	signal_halt.emit(halted);
+}
+
 const char *Dummy::enumerate_protocols(unsigned i) const
 {
 	if(i==0)
@@ -50,7 +66,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);
 	}
 }
@@ -65,6 +82,9 @@ unsigned Dummy::get_turnout(unsigned addr) const
 
 void Dummy::set_loco_speed(unsigned addr, unsigned speed)
 {
+	if(speed && halted)
+		return;
+
 	LocoState &loco = locos[addr];
 	loco.speed = speed;
 	signal_loco_speed.emit(addr, speed, loco.reverse);
@@ -99,6 +119,11 @@ bool Dummy::get_sensor(unsigned addr) const
 	return false;
 }
 
+float Dummy::get_telemetry_value(const string &name) const
+{
+	throw key_error(name);
+}
+
 void Dummy::tick()
 {
 	Time::TimeStamp t = Time::now();
@@ -106,6 +131,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);