2 #include <msp/core/maputils.h>
3 #include <msp/core/refptr.h>
4 #include <msp/datafile/parser.h>
5 #include <msp/datafile/writer.h>
6 #include <msp/io/print.h>
7 #include <msp/time/utils.h>
14 #include "signaltype.h"
16 #include "trackcircuit.h"
17 #include "tracktype.h"
20 #include "vehicletype.h"
28 bool zone_order(const R2C2::Zone *z1, const R2C2::Zone *z2)
30 return z1->get_number()<z2->get_number();
38 Layout::Layout(Catalogue &c, Driver *d):
41 next_turnout_id(0x800)
49 while(!trains.empty())
50 delete trains.begin()->second;
51 track_chains.del<Route>();
52 track_chains.del<Zone>();
53 objects.del<Signal>();
55 track_chains.del<Block>();
58 Driver &Layout::get_driver() const
61 throw logic_error("!driver");
65 void Layout::add(Object &o)
68 signal_object_added.emit(o);
71 void Layout::add(Track &t)
75 // Blocks must be recreated first
77 signal_object_added.emit(t);
81 void Layout::add(TrackChain &g)
83 if(track_chains.insert(g))
84 signal_track_chain_added.emit(g);
87 void Layout::add(Block &b)
89 if(track_chains.insert(b))
91 b.signal_reserved.connect(sigc::bind<0>(signal_block_reserved, sigc::ref(b)));
92 signal_track_chain_added.emit(b);
96 void Layout::add(Sensor &s)
100 s.signal_state_changed.connect(sigc::bind<0>(sigc::mem_fun(this, &Layout::sensor_state_changed), sigc::ref(s)));
101 s.signal_state_changed.connect(sigc::bind<0>(signal_sensor_state_changed, sigc::ref(s)));
106 const set<Object *> &Layout::get_all<Object>() const
108 return objects.get();
112 const set<Track *> &Layout::get_all<Track>() const
114 return objects.get<Track>();
118 const set<Signal *> &Layout::get_all<Signal>() const
120 return objects.get<Signal>();
124 const set<Vehicle *> &Layout::get_all<Vehicle>() const
126 return objects.get<Vehicle>();
130 const set<TrackChain *> &Layout::get_all<TrackChain>() const
132 return track_chains.get();
136 const set<Block *> &Layout::get_all<Block>() const
138 return track_chains.get<Block>();
142 const set<Route *> &Layout::get_all<Route>() const
144 return track_chains.get<Route>();
148 const set<Zone *> &Layout::get_all<Zone>() const
150 return track_chains.get<Zone>();
154 const set<Sensor *> &Layout::get_all<Sensor>() const
156 return sensors.get<Sensor>();
160 const set<TrackCircuit *> &Layout::get_all<TrackCircuit>() const
162 return sensors.get<TrackCircuit>();
166 T *Layout::pick(const Ray &ray)
168 const set<Object *> &objs = objects.get();
169 for(set<Object *>::const_iterator i=objs.begin(); i!=objs.end(); ++i)
170 if(T *t = dynamic_cast<T *>(*i))
171 if(t->collide_ray(ray))
177 template Object *Layout::pick<Object>(const Ray &);
178 template Track *Layout::pick<Track>(const Ray &);
179 template Signal *Layout::pick<Signal>(const Ray &);
180 template Vehicle *Layout::pick<Vehicle>(const Ray &);
182 void Layout::remove(Object &o)
185 signal_object_removed.emit(o);
188 void Layout::remove(Track &t)
192 // Blocks must be recreated first
194 signal_object_removed.emit(t);
198 void Layout::remove(TrackChain &g)
200 if(track_chains.erase(g))
201 signal_track_chain_removed.emit(g);
204 void Layout::remove(Sensor &s)
209 unsigned Layout::allocate_turnout_id()
211 set<unsigned> used_ids;
212 const set<Track *> &tracks = objects.get<Track>();
213 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
214 if((*i)->get_turnout_id())
215 used_ids.insert((*i)->get_turnout_id());
217 unsigned result = next_turnout_id;
218 while(used_ids.count(result))
220 next_turnout_id = result+1;
225 Block &Layout::get_block(unsigned id) const
227 const set<Block *> &blocks = track_chains.get<Block>();
228 for(set<Block *>::const_iterator i=blocks.begin(); i!=blocks.end(); ++i)
229 if((*i)->get_id()==id)
235 void Layout::create_blocks()
237 set<Track *> used_tracks;
238 const set<Block *> *blocks = &track_chains.get<Block>();
239 for(set<Block *>::const_iterator i=blocks->begin(); i!=blocks->end(); ++i)
241 const set<Track *> &btracks = (*i)->get_tracks();
242 used_tracks.insert(btracks.begin(), btracks.end());
245 const set<Track *> &tracks = objects.get<Track>();
246 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
247 if(used_tracks.count(*i)==0)
249 Block *block = new Block(*this, **i);
250 used_tracks.insert(block->get_tracks().begin(), block->get_tracks().end());
253 blocks = &track_chains.get<Block>();
254 for(set<Block *>::iterator i=blocks->begin(); i!=blocks->end(); ++i)
255 for(set<Block *>::iterator j=i; j!=blocks->end(); ++j)
257 (*i)->check_link(**j);
260 void Layout::create_blocks(Track &track)
262 /* Must collect the blocks in a set first while all tracks are still
263 guaranteed to have blocks and to avoid duplicate deletes */
264 set<Block *> del_blocks;
266 del_blocks.insert(&track.get_block());
268 const vector<Track *> &links = track.get_links();
269 for(vector<Track *>::const_iterator i=links.begin(); i!=links.end(); ++i)
271 del_blocks.insert(&(*i)->get_block());
273 for(set<Block *>::iterator i=del_blocks.begin(); i!=del_blocks.end(); ++i)
279 Route &Layout::get_route(const string &name) const
281 const set<Route *> &routes = track_chains.get<Route>();
282 for(set<Route *>::const_iterator i=routes.begin(); i!=routes.end(); ++i)
283 if((*i)->get_name()==name)
285 throw key_error(name);
288 void Layout::update_routes()
290 const set<Route *> &routes = track_chains.get<Route>();
291 for(set<Route *>::iterator i=routes.begin(); i!=routes.end(); ++i)
292 (*i)->update_turnouts();
295 Layout::ZoneArray Layout::get_zones(const string &group) const
298 const set<Zone *> &zones = track_chains.get<Zone>();
299 for(set<Zone *>::const_iterator i=zones.begin(); i!=zones.end(); ++i)
300 if((*i)->get_group()==group)
301 result.push_back(*i);
303 sort(result.begin(), result.end(), zone_order);
308 Zone &Layout::get_zone(const string &group, unsigned num) const
310 const set<Zone *> &zones = track_chains.get<Zone>();
311 for(set<Zone *>::const_iterator i=zones.begin(); i!=zones.end(); ++i)
312 if((*i)->get_group()==group && (*i)->get_number()==num)
315 throw key_error(format("%s %d", group, num));
318 void Layout::add_train(Train &t)
320 insert_unique(trains, t.get_address(), &t);
321 signal_train_added.emit(t);
324 Train &Layout::get_train(unsigned addr) const
326 return *get_item(trains, addr);
329 void Layout::remove_train(Train &t)
331 if(trains.erase(t.get_address()))
332 signal_train_removed.emit(t);
340 Time::TimeStamp t = Time::now();
346 for(set<Sensor *>::iterator i=sensors.get().begin(); i!=sensors.get().end(); ++i)
348 const set<Signal *> &signals = objects.get<Signal>();
349 for(set<Signal *>::iterator i=signals.begin(); i!=signals.end(); ++i)
351 for(map<unsigned, Train *>::iterator i=trains.begin(); i!=trains.end(); ++i)
352 i->second->tick(t, dt);
355 void Layout::emergency(const string &msg)
359 IO::print("Emergency: %s\n", msg);
360 signal_emergency.emit(msg);
363 void Layout::save(const string &fn) const
365 IO::BufferedFile out(fn, IO::M_WRITE);
366 DataFile::Writer writer(out);
369 writer.write((DataFile::Statement("base"), base));
371 const set<Track *> &tracks = objects.get<Track>();
372 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
374 DataFile::Statement st("track");
375 st.append((*i)->get_type().get_article_number());
380 const set<Signal *> &signals = objects.get<Signal>();
381 for(set<Signal *>::const_iterator i=signals.begin(); i!=signals.end(); ++i)
383 DataFile::Statement st("signal");
384 st.append((*i)->get_type().get_article_number());
389 const set<Route *> &routes = track_chains.get<Route>();
390 for(set<Route *>::const_iterator i=routes.begin(); i!=routes.end(); ++i)
392 if((*i)->is_temporary())
395 DataFile::Statement st("route");
400 const set<Zone *> &zones = track_chains.get<Zone>();
401 for(set<Zone *>::const_iterator i=zones.begin(); i!=zones.end(); ++i)
403 DataFile::Statement st("zone");
409 void Layout::save_dynamic(const string &fn) const
411 IO::BufferedFile out(fn, IO::M_WRITE);
412 DataFile::Writer writer(out);
414 const set<Track *> &tracks = objects.get<Track>();
415 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
416 if(unsigned tid = (*i)->get_turnout_id())
417 writer.write((DataFile::Statement("turnout"), tid, (*i)->get_active_path()));
419 for(map<unsigned, Train *>::const_iterator i=trains.begin(); i!=trains.end(); ++i)
421 DataFile::Statement st("train");
422 st.append(i->second->get_locomotive_type().get_article_number());
423 st.append(i->second->get_address());
424 st.append(i->second->get_protocol());
425 i->second->save(st.sub);
430 void Layout::sensor_state_changed(Sensor &sensor, Sensor::State state)
432 if(state==Sensor::ACTIVE)
435 if(TrackCircuit *tc = dynamic_cast<TrackCircuit *>(&sensor))
436 block = &tc->get_block();
438 if(block && !block->get_train())
439 emergency(format("Unreserved sensor %d triggered", sensor.get_address()));
445 Layout::Storage<B>::~Storage()
448 delete *base.begin();
452 bool Layout::Storage<B>::insert(B &b)
454 bool result = base.insert(&b).second;
461 bool Layout::Storage<B>::erase(B &b)
463 bool result = base.erase(&b);
471 const set<T *> &Layout::Storage<B>::get() const
473 for(list<Variant>::const_iterator i=caches.begin(); i!=caches.end(); ++i)
474 if(i->check_type<set<T *> >())
475 return i->value<set<T *> >();
477 caches.push_back(set<T *>());
478 set<T *> &result = caches.back().value<set<T *> >();
479 for(typename set<B *>::const_iterator i=base.begin(); i!=base.end(); ++i)
480 if(T *t = dynamic_cast<T *>(*i))
488 void Layout::Storage<B>::del()
490 set<T *> ts = get<T>();
491 for(typename set<T *>::iterator i=ts.begin(); i!=ts.end(); ++i)
497 Layout::Loader::Loader(Layout &l):
498 DataFile::ObjectLoader<Layout>(l),
501 add("base", &Layout::base);
502 add("route", static_cast<void (Loader::*)()>(&Loader::route));
503 add("signal", &Loader::signal);
504 add("track", static_cast<void (Loader::*)(ArticleNumber)>(&Loader::track));
505 add("train", static_cast<void (Loader::*)(ArticleNumber, unsigned, const std::string &)>(&Loader::train));
506 add("turnout", &Loader::turnout);
507 add("zone", &Loader::zone);
509 // Deprecated aliases
510 add("route", static_cast<void (Loader::*)(const string &)>(&Loader::route));
511 add("track", static_cast<void (Loader::*)(unsigned)>(&Loader::track));
512 add("train", static_cast<void (Loader::*)(unsigned, unsigned, const std::string &)>(&Loader::train));
515 void Layout::Loader::route()
517 Route *rte = new Route(obj);
521 void Layout::Loader::route(const string &n)
523 Route *rte = new Route(obj);
528 void Layout::Loader::signal(ArticleNumber art_nr)
530 Signal *sig = new Signal(obj, obj.catalogue.get_signal(art_nr));
534 void Layout::Loader::track(unsigned art_nr)
536 track(ArticleNumber(art_nr));
539 void Layout::Loader::track(ArticleNumber art_nr)
541 Track *trk = new Track(obj, obj.catalogue.get_track(art_nr));
544 const set<Track *> &tracks = obj.objects.get<Track>();
545 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
550 void Layout::Loader::train(unsigned art_nr, unsigned addr, const std::string &proto)
552 train(ArticleNumber(art_nr), addr, proto);
555 void Layout::Loader::train(ArticleNumber art_nr, unsigned addr, const std::string &proto)
557 Train *trn = new Train(obj, obj.catalogue.get_vehicle(art_nr), addr, proto);
561 void Layout::Loader::turnout(unsigned addr, unsigned path)
564 obj.driver->set_turnout(addr, path);
567 void Layout::Loader::zone()
569 Zone *zne = new Zone(obj);