3 This file is part of the MSP Märklin suite
4 Copyright © 2010 Mikkosoft Productions, Mikko Rasa
5 Distributed under the GPL
8 #include <msp/strings/formatter.h>
9 #include <msp/time/units.h>
11 #include "catalogue.h"
14 #include "timetable.h"
22 Timetable::Timetable(Train &t):
30 train.signal_arrived.connect(sigc::mem_fun(this, &Timetable::train_arrived));
31 train.get_layout().get_driver().signal_sensor.connect(sigc::mem_fun(this, &Timetable::sensor_event));
34 void Timetable::set_enabled(bool e)
39 void Timetable::reset()
42 wait_timeout = Time::TimeStamp();
47 void Timetable::clear()
53 void Timetable::append(const Row &row)
58 void Timetable::insert(unsigned i, const Row &row)
61 throw InvalidParameterValue("Insert position out of range");
63 rows.insert(rows.begin()+i, row);
68 const Timetable::Row &Timetable::get_row(unsigned i) const
71 throw InvalidParameterValue("Row index out of range");
75 void Timetable::tick(const Time::TimeStamp &t)
77 if(rows.empty() || !enabled)
80 if(wait_timeout && t>=wait_timeout)
82 wait_timeout = Time::TimeStamp();
83 current_row = (current_row+1)%rows.size();
89 Row &row = rows[current_row];
93 train.go_to(**parse_location(row.get_param<string>(0)).get_tracks().begin());
96 pending_block = &parse_location(row.get_param<string>(0));
97 pending_train = &train;
101 wait_timeout = t+row.get_param<unsigned>(0)*Time::sec;
105 pending_train = &train.get_layout().get_train(row.get_param<unsigned>(0));
106 pending_block = &parse_location(row.get_param<string>(1));
113 train.set_control("speed", row.get_param<unsigned>(0)/3.6*train.get_layout().get_catalogue().get_scale());
116 train.set_control("reverse", !train.get_control("reverse"));
119 train.set_route(&train.get_layout().get_route(row.get_param<string>(0)));
124 current_row = (current_row+1)%rows.size();
128 void Timetable::save(list<DataFile::Statement> &st) const
130 for(vector<Row>::const_iterator i=rows.begin(); i!=rows.end(); ++i)
131 st.push_back(i->save());
134 Block &Timetable::parse_location(const string &loc)
136 if(!loc.compare(0, 7, "sensor "))
137 return train.get_layout().get_block(lexical_cast<unsigned>(loc.substr(7))|0x1000);
138 throw Exception("Named blocks are not supported yet");
141 void Timetable::sensor_event(unsigned addr, bool state)
143 if(pending_block && pending_block->get_train()==pending_train && addr==pending_block->get_sensor_id() && state)
146 current_row = (current_row+1)%rows.size();
151 void Timetable::train_arrived()
153 Row &row = rows[current_row];
156 current_row = (current_row+1)%rows.size();
162 Timetable::Row::Row(RowType t):
167 Timetable::Row::Row(RowType t, const T &p):
174 const T &Timetable::Row::get_param(unsigned i) const
177 throw InvalidParameterValue("Parameter index out of range");
178 return params[i].value<T>();
181 string Timetable::Row::str() const
186 return "set route to "+get_param<string>(0);
188 return "travel to "+get_param<string>(0);
190 return format("wait for %d seconds", get_param<unsigned>(0));
192 return format("wait for train %d at %s", get_param<unsigned>(0), get_param<string>(1));
194 return "travel until arrival";
196 return format("set speed %d km/h", get_param<unsigned>(0));
200 return "set route "+get_param<string>(0);
202 return "invalid row";
206 DataFile::Statement Timetable::Row::save() const
211 return DataFile::Statement("goto"), get_param<string>(0);
213 return DataFile::Statement("travel"), get_param<string>(0);
215 return DataFile::Statement("wait"), get_param<unsigned>(0);
217 return DataFile::Statement("wait_train"), get_param<unsigned>(0), get_param<string>(1);
219 return DataFile::Statement("arrive");
221 return DataFile::Statement("speed"), get_param<unsigned>(0);
223 return DataFile::Statement("reverse");
225 return DataFile::Statement("route"), get_param<string>(0);
227 return DataFile::Statement();
231 Timetable::Row Timetable::Row::parse(const string &s)
233 if(!s.compare(0, 7, "travel "))
235 if(!s.compare(7, 3, "to "))
236 return Row(TRAVEL, s.substr(10));
237 else if(!s.compare(7, string::npos, "until arrival"))
240 else if(!s.compare(0, 9, "wait for "))
244 unsigned nondigit = 10;
245 while(nondigit<s.size() && isdigit(s[nondigit]))
247 return Row(WAIT_TIME, lexical_cast<unsigned>(s.substr(9, nondigit-9)));
249 else if(!s.compare(9, 6, "train "))
251 string::size_type at = s.find(" at ", 15);
254 Row row(WAIT_TRAIN, lexical_cast<unsigned>(s.substr(15, at-15)));
255 row.params.push_back(s.substr(at+4));
260 else if(!s.compare(0, 10, "set speed "))
262 unsigned nondigit = 11;
263 while(nondigit<s.size() && (isdigit(s[nondigit]) || s[nondigit]=='-'))
265 return Row(SPEED, lexical_cast<unsigned>(s.substr(10, nondigit-10)));
267 else if(s=="reverse")
269 else if(!s.compare(0, 10, "set route "))
271 if(!s.compare(10, 3, "to "))
272 return Row(GOTO, s.substr(13));
273 return Row(ROUTE, s.substr(10));
276 throw InvalidParameterValue("Invalid row");
280 Timetable::Loader::Loader(Timetable &tt):
281 DataFile::ObjectLoader<Timetable>(tt)
283 add("arrive", &Loader::arrive);
284 add("goto", &Loader::go_to);
285 add("route", &Loader::route);
286 add("speed", &Loader::speed);
287 add("reverse", &Loader::reverse);
288 add("travel", &Loader::travel);
289 add("wait", &Loader::wait);
290 add("wait_train", &Loader::wait_train);
293 void Timetable::Loader::arrive()
295 obj.rows.push_back(Row(ARRIVE));
298 void Timetable::Loader::go_to(const string &t)
300 obj.rows.push_back(Row(GOTO, t));
303 void Timetable::Loader::route(const string &r)
305 obj.rows.push_back(Row(ROUTE, r));
308 void Timetable::Loader::reverse()
310 obj.rows.push_back(Row(REVERSE));
313 void Timetable::Loader::speed(unsigned s)
315 obj.rows.push_back(Row(SPEED, s));
318 void Timetable::Loader::travel(const string &t)
320 obj.rows.push_back(Row(TRAVEL, t));
323 void Timetable::Loader::wait(unsigned t)
325 obj.rows.push_back(Row(WAIT_TIME, t));
328 void Timetable::Loader::wait_train(unsigned t, const string &b)
330 Row row(WAIT_TRAIN, t);
331 row.params.push_back(b);
332 obj.rows.push_back(row);
335 } // namespace Marklin