3 This file is part of R²C²
4 Copyright © 2010-2011 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):
31 train.signal_advanced.connect(sigc::mem_fun(this, &Timetable::train_advanced));
32 train.signal_arrived.connect(sigc::mem_fun(this, &Timetable::train_arrived));
33 Layout &layout = train.get_layout();
34 layout.get_driver().signal_sensor.connect(sigc::mem_fun(this, &Timetable::sensor_event));
35 layout.signal_block_reserved.connect(sigc::mem_fun(this, &Timetable::block_reserved));
38 void Timetable::set_enabled(bool e)
43 void Timetable::reset()
46 wait_timeout = Time::TimeStamp();
51 void Timetable::clear()
57 void Timetable::append(const Row &row)
62 void Timetable::insert(unsigned i, const Row &row)
65 throw InvalidParameterValue("Insert position out of range");
67 rows.insert(rows.begin()+i, row);
72 const Timetable::Row &Timetable::get_row(unsigned i) const
75 throw InvalidParameterValue("Row index out of range");
79 void Timetable::tick(const Time::TimeStamp &t, const Time::TimeDelta &)
81 if(rows.empty() || !enabled)
84 if(wait_timeout && t>=wait_timeout)
86 wait_timeout = Time::TimeStamp();
87 current_row = (current_row+1)%rows.size();
93 Row &row = rows[current_row];
98 if(!train.go_to(get_sensor(row.get_param<unsigned>(0))))
103 if(!train.go_to(get_zone(row.get_param<string>(0))))
107 pending_block = &get_sensor(row.get_param<unsigned>(0)).get_block();
108 pending_train = &train;
112 pending_block = &get_turnout(row.get_param<unsigned>(0)).get_block();
113 pending_train = (pending_block->get_train()==&train ? 0 : &train);
117 wait_timeout = t+row.get_param<unsigned>(0)*Time::sec;
122 unsigned unixtime = t.to_unixtime();
123 unsigned mod = row.get_param<unsigned>(1);
124 unsigned secs = ((mod+row.get_param<unsigned>(0))-(unixtime%mod))%mod;
125 wait_timeout = t+secs*Time::sec;
130 pending_train = &train.get_layout().get_train(row.get_param<unsigned>(0));
131 pending_block = &get_sensor(row.get_param<unsigned>(1)).get_block();
142 float speed = row.get_param<unsigned>(0)/3.6*train.get_layout().get_catalogue().get_scale();
143 train.ai_message(Message("set-target-speed", speed));
147 train.ai_message(Message("toggle-reverse"));
150 if(!train.set_route(&train.get_layout().get_route(row.get_param<string>(0))))
156 current_row = (current_row+1)%rows.size();
160 void Timetable::save(list<DataFile::Statement> &st) const
163 st.push_back((DataFile::Statement("tag"), tag));
164 for(vector<Row>::const_iterator i=rows.begin(); i!=rows.end(); ++i)
165 st.push_back(i->save());
168 Track &Timetable::get_sensor(unsigned id)
170 Block &block = train.get_layout().get_block(id|0x1000);
171 return **block.get_tracks().begin();
174 Track &Timetable::get_turnout(unsigned id)
176 Block &block = train.get_layout().get_block(id|0x2000);
177 return **block.get_tracks().begin();
180 Zone &Timetable::get_zone(const string &name)
182 string::size_type space = name.rfind(' ');
183 if(space==string::npos || space==0)
184 throw InvalidParameterValue("Invalid zone name");
185 unsigned number = lexical_cast<unsigned>(name.substr(space+1));
186 return train.get_layout().get_zone(name.substr(0, space), number);
189 void Timetable::sensor_event(unsigned addr, bool state)
191 if(pending_block && pending_block->get_train()==pending_train && addr==pending_block->get_sensor_id() && state)
194 current_row = (current_row+1)%rows.size();
199 void Timetable::block_reserved(Block &block, Train *trn)
201 if(&block==pending_block && trn==pending_train)
203 Row &row = rows[current_row];
204 if(row.type==TRAVEL_PAST && !pending_train)
207 current_row = (current_row+1)%rows.size();
213 void Timetable::train_advanced(Block &block)
215 Row &row = rows[current_row];
216 if(row.type==TRAVEL_PAST && &block==pending_block && pending_train)
220 void Timetable::train_arrived()
222 Row &row = rows[current_row];
225 current_row = (current_row+1)%rows.size();
233 Timetable::Row::Row(RowType t):
238 Timetable::Row::Row(RowType t, const T &p):
245 const T &Timetable::Row::get_param(unsigned i) const
248 throw InvalidParameterValue("Parameter index out of range");
249 return params[i].value<T>();
252 string Timetable::Row::str() const
257 return format("set route to sensor %d", get_param<unsigned>(0));
259 return "set route to "+get_param<string>(0);
261 return format("travel to sensor %d", get_param<unsigned>(0));
263 return format("travel past turnout %d", get_param<unsigned>(0));
265 return format("wait for %d seconds", get_param<unsigned>(0));
267 return format("wait until %d mod %d seconds", get_param<unsigned>(0), get_param<unsigned>(1));
269 return format("wait for train %d at %s", get_param<unsigned>(0), get_param<string>(1));
271 return "travel until arrival";
273 return format("set speed %d km/h", get_param<unsigned>(0));
277 return "set route "+get_param<string>(0);
279 return "invalid row";
283 DataFile::Statement Timetable::Row::save() const
288 return DataFile::Statement("goto_sensor"), get_param<unsigned>(0);
290 return DataFile::Statement("goto_zone"), get_param<string>(0);
292 return DataFile::Statement("travel_to"), get_param<unsigned>(0);
294 return DataFile::Statement("travel_past"), get_param<unsigned>(0);
296 return DataFile::Statement("wait"), get_param<unsigned>(0);
298 return DataFile::Statement("wait_until"), get_param<unsigned>(0), get_param<unsigned>(1);
300 return DataFile::Statement("wait_train"), get_param<unsigned>(0), get_param<unsigned>(1);
302 return DataFile::Statement("arrive");
304 return DataFile::Statement("speed"), get_param<unsigned>(0);
306 return DataFile::Statement("reverse");
308 return DataFile::Statement("route"), get_param<string>(0);
310 return DataFile::Statement();
314 Timetable::Row Timetable::Row::parse(const string &s)
316 if(!s.compare(0, 7, "travel "))
318 if(!s.compare(7, 10, "to sensor "))
319 return Row(TRAVEL_TO, lexical_cast<unsigned>(s.substr(17)));
320 else if(!s.compare(7, 13, "past turnout "))
321 return Row(TRAVEL_PAST, lexical_cast<unsigned>(s.substr(20)));
322 else if(!s.compare(7, string::npos, "until arrival"))
325 else if(!s.compare(0, 9, "wait for "))
329 unsigned nondigit = 10;
330 while(nondigit<s.size() && isdigit(s[nondigit]))
332 return Row(WAIT_TIME, lexical_cast<unsigned>(s.substr(9, nondigit-9)));
334 else if(!s.compare(9, 6, "train "))
336 string::size_type at = s.find(" at sensor ", 15);
339 Row row(WAIT_TRAIN, lexical_cast<unsigned>(s.substr(15, at-15)));
340 row.params.push_back(lexical_cast<unsigned>(s.substr(at+11)));
345 else if(!s.compare(0, 11, "wait until "))
347 string::size_type mod = s.find(" mod ", 11);
348 unsigned nondigit = (mod!=string::npos ? mod+5 : 11);
349 while(nondigit<s.size() && isdigit(s[nondigit]))
351 if(mod!=string::npos)
353 unsigned time = lexical_cast<unsigned>(s.substr(11, mod-11));
354 Row row(WAIT_UNTIL, time);
355 row.params.push_back(lexical_cast<unsigned>(s.substr(mod+5, nondigit-mod-5)));
360 unsigned time = lexical_cast<unsigned>(s.substr(11, nondigit-11));
361 Row row(WAIT_UNTIL, time);
362 row.params.push_back(3600);
366 else if(!s.compare(0, 10, "set speed "))
368 unsigned nondigit = 11;
369 while(nondigit<s.size() && (isdigit(s[nondigit]) || s[nondigit]=='-'))
371 return Row(SPEED, lexical_cast<unsigned>(s.substr(10, nondigit-10)));
373 else if(s=="reverse")
375 else if(!s.compare(0, 10, "set route "))
377 if(!s.compare(10, 3, "to "))
379 if(!s.compare(13, 7, "sensor "))
380 return Row(GOTO_SENSOR, lexical_cast<unsigned>(s.substr(20)));
382 return Row(GOTO_ZONE, s.substr(13));
384 return Row(ROUTE, s.substr(10));
387 throw InvalidParameterValue("Invalid row");
391 Timetable::Loader::Loader(Timetable &tt):
392 DataFile::ObjectLoader<Timetable>(tt)
394 add("arrive", &Loader::arrive);
395 add("goto_sensor", &Loader::goto_sensor);
396 add("goto_zone", &Loader::goto_zone);
397 add("route", &Loader::route);
398 add("speed", &Loader::speed);
399 add("reverse", &Loader::reverse);
400 add("tag", &Loader::tag);
401 add("travel_to", &Loader::travel_to);
402 add("travel_past", &Loader::travel_past);
403 add("wait", &Loader::wait);
404 add("wait_train", &Loader::wait_train);
405 add("wait_until", &Loader::wait_until);
408 add("goto", &Loader::goto_sensor_str);
409 add("travel", &Loader::travel_to);
412 void Timetable::Loader::arrive()
414 obj.rows.push_back(Row(ARRIVE));
417 void Timetable::Loader::goto_sensor(unsigned s)
419 obj.rows.push_back(Row(GOTO_SENSOR, s));
422 void Timetable::Loader::goto_sensor_str(const string &s)
424 if(!s.compare(0, 7, "sensor "))
425 obj.rows.push_back(Row(GOTO_SENSOR, lexical_cast<unsigned>(s.substr(7))));
428 void Timetable::Loader::goto_zone(const string &z)
430 obj.rows.push_back(Row(GOTO_ZONE, z));
433 void Timetable::Loader::route(const string &r)
435 obj.rows.push_back(Row(ROUTE, r));
438 void Timetable::Loader::reverse()
440 obj.rows.push_back(Row(REVERSE));
443 void Timetable::Loader::speed(unsigned s)
445 obj.rows.push_back(Row(SPEED, s));
448 void Timetable::Loader::tag(const string &t)
453 void Timetable::Loader::travel_to(unsigned s)
455 obj.rows.push_back(Row(TRAVEL_TO, s));
458 void Timetable::Loader::travel_past(unsigned s)
460 obj.rows.push_back(Row(TRAVEL_PAST, s));
463 void Timetable::Loader::wait(unsigned t)
465 obj.rows.push_back(Row(WAIT_TIME, t));
468 void Timetable::Loader::wait_train(unsigned t, unsigned s)
470 Row row(WAIT_TRAIN, t);
471 row.params.push_back(s);
472 obj.rows.push_back(row);
475 void Timetable::Loader::wait_until(unsigned t, unsigned m)
477 Row row(WAIT_UNTIL, t);
478 row.params.push_back(m);
479 obj.rows.push_back(row);