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):
29 train.signal_arrived.connect(sigc::mem_fun(this, &Timetable::train_arrived));
30 train.get_layout().get_driver().signal_sensor.connect(sigc::mem_fun(this, &Timetable::sensor_event));
33 void Timetable::set_enabled(bool e)
38 void Timetable::clear()
44 void Timetable::append(const Row &row)
49 void Timetable::insert(unsigned i, const Row &row)
52 throw InvalidParameterValue("Insert position out of range");
54 rows.insert(rows.begin()+i, row);
59 const Timetable::Row &Timetable::get_row(unsigned i) const
62 throw InvalidParameterValue("Row index out of range");
66 void Timetable::tick(const Time::TimeStamp &t)
68 if(rows.empty() || !enabled)
71 if(wait_timeout && t>=wait_timeout)
73 wait_timeout = Time::TimeStamp();
74 current_row = (current_row+1)%rows.size();
80 Row &row = rows[current_row];
84 train.go_to(**parse_location(row.strparam).get_tracks().begin());
88 pending_block = &parse_location(row.strparam);
92 wait_timeout = t+row.intparam*Time::sec;
96 train.set_control("speed", row.intparam/3.6*train.get_layout().get_catalogue().get_scale());
99 train.set_route(&train.get_layout().get_route(row.strparam));
104 current_row = (current_row+1)%rows.size();
108 void Timetable::save(list<DataFile::Statement> &st) const
110 for(vector<Row>::const_iterator i=rows.begin(); i!=rows.end(); ++i)
115 st.push_back((DataFile::Statement("goto"), i->strparam));
118 st.push_back((DataFile::Statement("travel"), i->strparam));
121 st.push_back((DataFile::Statement("wait"), i->intparam));
124 st.push_back((DataFile::Statement("speed"), i->intparam));
127 st.push_back((DataFile::Statement("route"), i->strparam));
133 Block &Timetable::parse_location(const string &loc)
135 if(!loc.compare(0, 7, "sensor "))
136 return train.get_layout().get_block(lexical_cast<unsigned>(loc.substr(7))|0x1000);
137 throw Exception("Named blocks are not supported yet");
140 void Timetable::sensor_event(unsigned addr, bool state)
142 if(pending_block && pending_block->get_train()==&train && addr==pending_block->get_sensor_id() && state)
145 current_row = (current_row+1)%rows.size();
150 void Timetable::train_arrived()
152 Row &row = rows[current_row];
155 current_row = (current_row+1)%rows.size();
161 Timetable::Row::Row(RowType t, int p):
166 Timetable::Row::Row(RowType t, const string &p):
172 string Timetable::Row::str() const
177 return "go to "+strparam;
179 return "travel to "+strparam;
181 return format("wait for %d seconds", intparam);
183 return format("set speed %d km/h", intparam);
185 return "set route "+strparam;
187 return "invalid row";
191 Timetable::Row Timetable::Row::parse(const string &s)
193 if(!s.compare(0, 6, "go to "))
194 return Row(GOTO, s.substr(6));
195 else if(!s.compare(0, 10, "travel to "))
196 return Row(TRAVEL, s.substr(10));
197 else if(!s.compare(0, 9, "wait for ") && isdigit(s[9]))
199 unsigned nondigit = 10;
200 while(nondigit<s.size() && isdigit(s[nondigit]))
202 return Row(WAIT, lexical_cast<unsigned>(s.substr(9, nondigit-9)));
204 else if(!s.compare(0, 10, "set speed "))
206 unsigned nondigit = 11;
207 while(nondigit<s.size() && isdigit(s[nondigit]))
209 return Row(SPEED, lexical_cast<unsigned>(s.substr(10, nondigit-10)));
211 else if(!s.compare(0, 10, "set route "))
212 return Row(ROUTE, s.substr(10));
214 throw InvalidParameterValue("Invalid row");
218 Timetable::Loader::Loader(Timetable &tt):
219 DataFile::ObjectLoader<Timetable>(tt)
221 add("goto", &Loader::go_to);
222 add("route", &Loader::route);
223 add("speed", &Loader::speed);
224 add("travel", &Loader::travel);
225 add("wait", &Loader::wait);
228 void Timetable::Loader::go_to(const string &t)
230 obj.rows.push_back(Row(GOTO, t));
233 void Timetable::Loader::route(const string &r)
235 obj.rows.push_back(Row(ROUTE, r));
238 void Timetable::Loader::speed(int s)
240 obj.rows.push_back(Row(SPEED, s));
243 void Timetable::Loader::travel(const string &t)
245 obj.rows.push_back(Row(TRAVEL, t));
248 void Timetable::Loader::wait(unsigned t)
250 obj.rows.push_back(Row(WAIT, t));
253 } // namespace Marklin