From 6010ad6857ce5690f4053bf8795f2c476daa4694 Mon Sep 17 00:00:00 2001
From: Mikko Rasa <tdb@tdb.fi>
Date: Tue, 23 Nov 2010 21:54:33 +0000
Subject: [PATCH] Save turnout states and restore them on startup Don't send
 turnout commands before establishing sync with the device

---
 source/engineer/engineer.cpp  |  2 +-
 source/libr2c2/intellibox.cpp |  7 +++++--
 source/libr2c2/intellibox.h   |  1 +
 source/libr2c2/layout.cpp     | 13 ++++++++++++-
 source/libr2c2/layout.h       |  3 ++-
 5 files changed, 21 insertions(+), 5 deletions(-)

diff --git a/source/engineer/engineer.cpp b/source/engineer/engineer.cpp
index 1f3b7dc..8db0be6 100644
--- a/source/engineer/engineer.cpp
+++ b/source/engineer/engineer.cpp
@@ -131,7 +131,7 @@ Engineer::~Engineer()
 	layout.get_driver().flush();
 
 	if(!options.simulate)
-		layout.save_trains(options.state_fn);
+		layout.save_dynamic(options.state_fn);
 
 	delete overlay;
 	delete root;
diff --git a/source/libr2c2/intellibox.cpp b/source/libr2c2/intellibox.cpp
index 7702ed6..84d576b 100644
--- a/source/libr2c2/intellibox.cpp
+++ b/source/libr2c2/intellibox.cpp
@@ -242,7 +242,7 @@ void Intellibox::set_turnout(unsigned addr, unsigned state)
 {
 	Turnout &turnout = turnouts[addr];
 	unsigned mask = (1<<turnout.bits)-1;
-	if(((state^turnout.state)&mask)==0 || ((state^turnout.pending)&mask)==0)
+	if(((state^turnout.state)&mask)==0 || ((state^turnout.pending)&mask)==0 || !turnout.synced)
 	{
 		turnout.state = state;
 		turnout.pending = state;
@@ -601,6 +601,8 @@ void Intellibox::process_reply(const Time::TimeStamp &t)
 				turnout.pending = turnout.state;
 				signal_turnout.emit(addr, turnout.state);
 			}
+
+			turnout.synced = true;
 		}
 		else
 			error(cmd, err);
@@ -748,7 +750,8 @@ Intellibox::Turnout::Turnout():
 	bits(1),
 	state(0),
 	active(false),
-	pending(false)
+	synced(false),
+	pending(0)
 { }
 
 
diff --git a/source/libr2c2/intellibox.h b/source/libr2c2/intellibox.h
index a4eed30..e5f63de 100644
--- a/source/libr2c2/intellibox.h
+++ b/source/libr2c2/intellibox.h
@@ -96,6 +96,7 @@ private:
 		unsigned bits;
 		unsigned state;
 		bool active;
+		bool synced;
 		unsigned pending;
 		Msp::Time::TimeStamp off_timeout;
 
diff --git a/source/libr2c2/layout.cpp b/source/libr2c2/layout.cpp
index cbe226a..d6bd9ee 100644
--- a/source/libr2c2/layout.cpp
+++ b/source/libr2c2/layout.cpp
@@ -312,11 +312,15 @@ void Layout::save(const string &fn) const
 	}
 }
 
-void Layout::save_trains(const string &fn) const
+void Layout::save_dynamic(const string &fn) const
 {
 	IO::BufferedFile out(fn, IO::M_WRITE);
 	DataFile::Writer writer(out);
 
+	for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
+		if(unsigned tid = (*i)->get_turnout_id())
+			writer.write((DataFile::Statement("turnout"), tid, (*i)->get_active_path()));
+
 	for(map<unsigned, Train *>::const_iterator i=trains.begin(); i!=trains.end(); ++i)
 	{
 		DataFile::Statement st("train");
@@ -351,6 +355,7 @@ Layout::Loader::Loader(Layout &l):
 	add("route", static_cast<void (Loader::*)()>(&Loader::route));
 	add("track", static_cast<void (Loader::*)(ArticleNumber)>(&Loader::track));
 	add("train", static_cast<void (Loader::*)(ArticleNumber, unsigned, const std::string &)>(&Loader::train));
+	add("turnout", &Loader::turnout);
 	add("zone",  &Loader::zone);
 
 	// Deprecated aliases
@@ -404,6 +409,12 @@ void Layout::Loader::train(ArticleNumber art_nr, unsigned addr, const std::strin
 	load_sub(*trn);
 }
 
+void Layout::Loader::turnout(unsigned addr, unsigned path)
+{
+	if(obj.driver)
+		obj.driver->set_turnout(addr, path);
+}
+
 void Layout::Loader::zone()
 {
 	Zone *zne = new Zone(obj);
diff --git a/source/libr2c2/layout.h b/source/libr2c2/layout.h
index 6ef7e09..8c143ac 100644
--- a/source/libr2c2/layout.h
+++ b/source/libr2c2/layout.h
@@ -43,6 +43,7 @@ public:
 		void track(ArticleNumber);
 		void train(unsigned, unsigned, const std::string &);
 		void train(ArticleNumber, unsigned, const std::string &);
+		void turnout(unsigned, unsigned);
 		void zone();
 	};
 
@@ -120,7 +121,7 @@ public:
 	void emergency(const std::string &);
 
 	void save(const std::string &) const;
-	void save_trains(const std::string &) const;
+	void save_dynamic(const std::string &) const;
 private:
 	void sensor_event(unsigned, bool);
 };
-- 
2.43.0