3 This file is part of R²C²
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 if(!train.go_to(get_sensor(row.get_param<unsigned>(0))))
97 if(!train.go_to(get_zone(row.get_param<string>(0))))
101 pending_block = &get_sensor(row.get_param<unsigned>(0)).get_block();
102 pending_train = &train;
106 wait_timeout = t+row.get_param<unsigned>(0)*Time::sec;
111 unsigned unixtime = t.to_unixtime();
112 unsigned mod = row.get_param<unsigned>(1);
113 unsigned secs = ((mod+row.get_param<unsigned>(0))-(unixtime%mod))%mod;
114 wait_timeout = t+secs*Time::sec;
119 pending_train = &train.get_layout().get_train(row.get_param<unsigned>(0));
120 pending_block = &get_sensor(row.get_param<unsigned>(1)).get_block();
127 train.set_control("speed", row.get_param<unsigned>(0)/3.6*train.get_layout().get_catalogue().get_scale());
130 train.set_control("reverse", !train.get_control("reverse"));
133 if(!train.set_route(&train.get_layout().get_route(row.get_param<string>(0))))
139 current_row = (current_row+1)%rows.size();
143 void Timetable::save(list<DataFile::Statement> &st) const
145 for(vector<Row>::const_iterator i=rows.begin(); i!=rows.end(); ++i)
146 st.push_back(i->save());
149 Track &Timetable::get_sensor(unsigned id)
151 Block &block = train.get_layout().get_block(id|0x1000);
152 return **block.get_tracks().begin();
155 Zone &Timetable::get_zone(const string &name)
157 string::size_type space = name.rfind(' ');
158 if(space==string::npos || space==0)
159 throw InvalidParameterValue("Invalid zone name");
160 unsigned number = lexical_cast<unsigned>(name.substr(space+1));
161 return train.get_layout().get_zone(name.substr(0, space), number);
164 void Timetable::sensor_event(unsigned addr, bool state)
166 if(pending_block && pending_block->get_train()==pending_train && addr==pending_block->get_sensor_id() && state)
169 current_row = (current_row+1)%rows.size();
174 void Timetable::train_arrived()
176 Row &row = rows[current_row];
179 current_row = (current_row+1)%rows.size();
185 Timetable::Row::Row(RowType t):
190 Timetable::Row::Row(RowType t, const T &p):
197 const T &Timetable::Row::get_param(unsigned i) const
200 throw InvalidParameterValue("Parameter index out of range");
201 return params[i].value<T>();
204 string Timetable::Row::str() const
209 return "set route to sensor "+get_param<unsigned>(0);
211 return "set route to "+get_param<string>(0);
213 return "travel to "+get_param<string>(0);
215 return format("wait for %d seconds", get_param<unsigned>(0));
217 return format("wait until %d mod %d seconds", get_param<unsigned>(0), get_param<unsigned>(1));
219 return format("wait for train %d at %s", get_param<unsigned>(0), get_param<string>(1));
221 return "travel until arrival";
223 return format("set speed %d km/h", get_param<unsigned>(0));
227 return "set route "+get_param<string>(0);
229 return "invalid row";
233 DataFile::Statement Timetable::Row::save() const
238 return DataFile::Statement("goto_sensor"), get_param<unsigned>(0);
240 return DataFile::Statement("goto_zone"), get_param<string>(0);
242 return DataFile::Statement("travel"), get_param<string>(0);
244 return DataFile::Statement("wait"), get_param<unsigned>(0);
246 return DataFile::Statement("wait_until"), get_param<unsigned>(0), get_param<unsigned>(1);
248 return DataFile::Statement("wait_train"), get_param<unsigned>(0), get_param<unsigned>(1);
250 return DataFile::Statement("arrive");
252 return DataFile::Statement("speed"), get_param<unsigned>(0);
254 return DataFile::Statement("reverse");
256 return DataFile::Statement("route"), get_param<string>(0);
258 return DataFile::Statement();
262 Timetable::Row Timetable::Row::parse(const string &s)
264 if(!s.compare(0, 7, "travel "))
266 if(!s.compare(7, 10, "to sensor "))
267 return Row(TRAVEL, lexical_cast<unsigned>(s.substr(17)));
268 else if(!s.compare(7, string::npos, "until arrival"))
271 else if(!s.compare(0, 9, "wait for "))
275 unsigned nondigit = 10;
276 while(nondigit<s.size() && isdigit(s[nondigit]))
278 return Row(WAIT_TIME, lexical_cast<unsigned>(s.substr(9, nondigit-9)));
280 else if(!s.compare(9, 6, "train "))
282 string::size_type at = s.find(" at sensor ", 15);
285 Row row(WAIT_TRAIN, lexical_cast<unsigned>(s.substr(15, at-15)));
286 row.params.push_back(lexical_cast<unsigned>(s.substr(at+11)));
291 else if(!s.compare(0, 11, "wait until "))
293 string::size_type mod = s.find(" mod ", 11);
294 unsigned nondigit = (mod!=string::npos ? mod+5 : 11);
295 while(nondigit<s.size() && isdigit(s[nondigit]))
297 if(mod!=string::npos)
299 unsigned time = lexical_cast<unsigned>(s.substr(11, mod-11));
300 Row row(WAIT_UNTIL, time);
301 row.params.push_back(lexical_cast<unsigned>(s.substr(mod+5, nondigit-mod-5)));
306 unsigned time = lexical_cast<unsigned>(s.substr(11, nondigit-11));
307 Row row(WAIT_UNTIL, time);
308 row.params.push_back(3600);
312 else if(!s.compare(0, 10, "set speed "))
314 unsigned nondigit = 11;
315 while(nondigit<s.size() && (isdigit(s[nondigit]) || s[nondigit]=='-'))
317 return Row(SPEED, lexical_cast<unsigned>(s.substr(10, nondigit-10)));
319 else if(s=="reverse")
321 else if(!s.compare(0, 10, "set route "))
323 if(!s.compare(10, 3, "to "))
325 if(!s.compare(13, 7, "sensor "))
326 return Row(GOTO_SENSOR, lexical_cast<unsigned>(s.substr(20)));
328 return Row(GOTO_ZONE, s.substr(13));
330 return Row(ROUTE, s.substr(10));
333 throw InvalidParameterValue("Invalid row");
337 Timetable::Loader::Loader(Timetable &tt):
338 DataFile::ObjectLoader<Timetable>(tt)
340 add("arrive", &Loader::arrive);
341 add("goto_sensor", static_cast<void (Loader::*)(unsigned)>(&Loader::goto_sensor));
342 add("goto_zone", &Loader::goto_zone);
343 add("route", &Loader::route);
344 add("speed", &Loader::speed);
345 add("reverse", &Loader::reverse);
346 add("travel", &Loader::travel);
347 add("wait", &Loader::wait);
348 add("wait_train", &Loader::wait_train);
349 add("wait_until", &Loader::wait_until);
352 add("goto", static_cast<void (Loader::*)(const string &)>(&Loader::goto_sensor));
355 void Timetable::Loader::arrive()
357 obj.rows.push_back(Row(ARRIVE));
360 void Timetable::Loader::goto_sensor(unsigned s)
362 obj.rows.push_back(Row(GOTO_SENSOR, s));
365 void Timetable::Loader::goto_sensor(const string &s)
367 if(!s.compare(0, 7, "sensor "))
368 obj.rows.push_back(Row(GOTO_SENSOR, lexical_cast<unsigned>(s.substr(7))));
371 void Timetable::Loader::goto_zone(const string &z)
373 obj.rows.push_back(Row(GOTO_ZONE, z));
376 void Timetable::Loader::route(const string &r)
378 obj.rows.push_back(Row(ROUTE, r));
381 void Timetable::Loader::reverse()
383 obj.rows.push_back(Row(REVERSE));
386 void Timetable::Loader::speed(unsigned s)
388 obj.rows.push_back(Row(SPEED, s));
391 void Timetable::Loader::travel(const string &t)
393 obj.rows.push_back(Row(TRAVEL, t));
396 void Timetable::Loader::wait(unsigned t)
398 obj.rows.push_back(Row(WAIT_TIME, t));
401 void Timetable::Loader::wait_train(unsigned t, unsigned s)
403 Row row(WAIT_TRAIN, t);
404 row.params.push_back(s);
405 obj.rows.push_back(row);
408 void Timetable::Loader::wait_until(unsigned t, unsigned m)
410 Row row(WAIT_UNTIL, t);
411 row.params.push_back(m);
412 obj.rows.push_back(row);