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>
10 #include "catalogue.h"
15 #include "signaltype.h"
17 #include "trackcircuit.h"
18 #include "tracktype.h"
21 #include "vehicletype.h"
29 bool zone_order(const R2C2::Zone *z1, const R2C2::Zone *z2)
31 return z1->get_number()<z2->get_number();
39 Layout::Layout(Catalogue &c, Driver *d):
42 next_turnout_id(0x800)
52 while(!trains.empty())
53 delete trains.begin()->second;
54 track_chains.del<Route>();
55 track_chains.del<Zone>();
56 objects.del<Signal>();
58 track_chains.del<Block>();
61 Driver &Layout::get_driver() const
64 throw logic_error("!driver");
68 void Layout::add(Object &o)
71 signal_object_added.emit(o);
74 void Layout::add(Track &t)
78 // Blocks must be recreated first
80 signal_object_added.emit(t);
84 void Layout::add(TrackChain &g)
86 if(track_chains.insert(g))
87 signal_track_chain_added.emit(g);
90 void Layout::add(Block &b)
92 if(track_chains.insert(b))
94 b.signal_reserved.connect(sigc::bind<0>(signal_block_reserved, sigc::ref(b)));
95 signal_track_chain_added.emit(b);
99 void Layout::add(Sensor &s)
101 if(sensors.insert(s))
103 s.signal_state_changed.connect(sigc::bind<0>(sigc::mem_fun(this, &Layout::sensor_state_changed), sigc::ref(s)));
104 s.signal_state_changed.connect(sigc::bind<0>(signal_sensor_state_changed, sigc::ref(s)));
108 void Layout::add(BeamGate &g)
110 add(static_cast<Object &>(g));
111 add(static_cast<Sensor &>(g));
115 const set<Object *> &Layout::get_all<Object>() const
117 return objects.get();
121 const set<Track *> &Layout::get_all<Track>() const
123 return objects.get<Track>();
127 const set<Signal *> &Layout::get_all<Signal>() const
129 return objects.get<Signal>();
133 const set<Vehicle *> &Layout::get_all<Vehicle>() const
135 return objects.get<Vehicle>();
139 const set<TrackChain *> &Layout::get_all<TrackChain>() const
141 return track_chains.get();
145 const set<Block *> &Layout::get_all<Block>() const
147 return track_chains.get<Block>();
151 const set<Route *> &Layout::get_all<Route>() const
153 return track_chains.get<Route>();
157 const set<Zone *> &Layout::get_all<Zone>() const
159 return track_chains.get<Zone>();
163 const set<Sensor *> &Layout::get_all<Sensor>() const
165 return sensors.get<Sensor>();
169 const set<TrackCircuit *> &Layout::get_all<TrackCircuit>() const
171 return sensors.get<TrackCircuit>();
175 const set<BeamGate *> &Layout::get_all<BeamGate>() const
177 return sensors.get<BeamGate>();
181 T *Layout::pick(const Ray &ray)
183 const set<Object *> &objs = objects.get();
184 for(set<Object *>::const_iterator i=objs.begin(); i!=objs.end(); ++i)
185 if(T *t = dynamic_cast<T *>(*i))
186 if(t->collide_ray(ray))
192 template Object *Layout::pick<Object>(const Ray &);
193 template Track *Layout::pick<Track>(const Ray &);
194 template Signal *Layout::pick<Signal>(const Ray &);
195 template Vehicle *Layout::pick<Vehicle>(const Ray &);
197 void Layout::remove(Object &o)
200 signal_object_removed.emit(o);
203 void Layout::remove(Track &t)
207 // Blocks must be recreated first
209 signal_object_removed.emit(t);
213 void Layout::remove(TrackChain &g)
215 if(track_chains.erase(g))
216 signal_track_chain_removed.emit(g);
219 void Layout::remove(Sensor &s)
224 void Layout::remove(BeamGate &g)
226 remove(static_cast<Object &>(g));
227 remove(static_cast<Sensor &>(g));
230 unsigned Layout::allocate_turnout_id()
232 set<unsigned> used_ids;
233 const set<Track *> &tracks = objects.get<Track>();
234 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
235 if((*i)->get_turnout_id())
236 used_ids.insert((*i)->get_turnout_id());
238 unsigned result = next_turnout_id;
239 while(used_ids.count(result))
241 next_turnout_id = result+1;
246 Block &Layout::get_block(unsigned id) const
248 const set<Block *> &blocks = track_chains.get<Block>();
249 for(set<Block *>::const_iterator i=blocks.begin(); i!=blocks.end(); ++i)
250 if((*i)->get_id()==id)
256 void Layout::create_blocks()
258 set<Track *> used_tracks;
259 const set<Block *> *blocks = &track_chains.get<Block>();
260 for(set<Block *>::const_iterator i=blocks->begin(); i!=blocks->end(); ++i)
262 const set<Track *> &btracks = (*i)->get_tracks();
263 used_tracks.insert(btracks.begin(), btracks.end());
266 const set<Track *> &tracks = objects.get<Track>();
267 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
268 if(used_tracks.count(*i)==0)
270 Block *block = new Block(*this, **i);
271 used_tracks.insert(block->get_tracks().begin(), block->get_tracks().end());
274 blocks = &track_chains.get<Block>();
275 for(set<Block *>::iterator i=blocks->begin(); i!=blocks->end(); ++i)
276 for(set<Block *>::iterator j=i; j!=blocks->end(); ++j)
278 (*i)->check_link(**j);
281 void Layout::create_blocks(Track &track)
283 /* Must collect the blocks in a set first while all tracks are still
284 guaranteed to have blocks and to avoid duplicate deletes */
285 set<Block *> del_blocks;
287 del_blocks.insert(&track.get_block());
289 const vector<Track *> &links = track.get_links();
290 for(vector<Track *>::const_iterator i=links.begin(); i!=links.end(); ++i)
292 del_blocks.insert(&(*i)->get_block());
294 for(set<Block *>::iterator i=del_blocks.begin(); i!=del_blocks.end(); ++i)
300 Route &Layout::get_route(const string &name) const
302 const set<Route *> &routes = track_chains.get<Route>();
303 for(set<Route *>::const_iterator i=routes.begin(); i!=routes.end(); ++i)
304 if((*i)->get_name()==name)
306 throw key_error(name);
309 void Layout::update_routes()
311 const set<Route *> &routes = track_chains.get<Route>();
312 for(set<Route *>::iterator i=routes.begin(); i!=routes.end(); ++i)
313 (*i)->update_turnouts();
316 Layout::ZoneArray Layout::get_zones(const string &group) const
319 const set<Zone *> &zones = track_chains.get<Zone>();
320 for(set<Zone *>::const_iterator i=zones.begin(); i!=zones.end(); ++i)
321 if((*i)->get_group()==group)
322 result.push_back(*i);
324 sort(result.begin(), result.end(), zone_order);
329 Zone &Layout::get_zone(const string &group, unsigned num) const
331 const set<Zone *> &zones = track_chains.get<Zone>();
332 for(set<Zone *>::const_iterator i=zones.begin(); i!=zones.end(); ++i)
333 if((*i)->get_group()==group && (*i)->get_number()==num)
336 throw key_error(format("%s %d", group, num));
339 void Layout::add_train(Train &t)
341 insert_unique(trains, t.get_address(), &t);
342 signal_train_added.emit(t);
345 Train &Layout::get_train(unsigned addr) const
347 return *get_item(trains, addr);
350 void Layout::remove_train(Train &t)
352 if(trains.erase(t.get_address()))
353 signal_train_removed.emit(t);
361 Time::TimeStamp t = Time::now();
369 for(set<Sensor *>::iterator i=sensors.get().begin(); i!=sensors.get().end(); ++i)
371 const set<Signal *> &signals = objects.get<Signal>();
372 for(set<Signal *>::iterator i=signals.begin(); i!=signals.end(); ++i)
374 for(map<unsigned, Train *>::iterator i=trains.begin(); i!=trains.end(); ++i)
378 void Layout::emergency(const string &msg)
382 IO::print("Emergency: %s\n", msg);
383 signal_emergency.emit(msg);
386 void Layout::save(const string &fn) const
388 IO::BufferedFile out(fn, IO::M_WRITE);
389 DataFile::Writer writer(out);
392 writer.write((DataFile::Statement("base"), base));
394 const set<Track *> &tracks = objects.get<Track>();
395 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
397 DataFile::Statement st("track");
398 st.append((*i)->get_type().get_article_number());
403 const set<Signal *> &signals = objects.get<Signal>();
404 for(set<Signal *>::const_iterator i=signals.begin(); i!=signals.end(); ++i)
406 DataFile::Statement st("signal");
407 st.append((*i)->get_type().get_article_number());
412 const set<BeamGate *> &gates = objects.get<BeamGate>();
413 for(set<BeamGate *>::const_iterator i=gates.begin(); i!=gates.end(); ++i)
415 DataFile::Statement st("beamgate");
420 const set<Route *> &routes = track_chains.get<Route>();
421 for(set<Route *>::const_iterator i=routes.begin(); i!=routes.end(); ++i)
423 if((*i)->is_temporary())
426 DataFile::Statement st("route");
431 const set<Zone *> &zones = track_chains.get<Zone>();
432 for(set<Zone *>::const_iterator i=zones.begin(); i!=zones.end(); ++i)
434 DataFile::Statement st("zone");
440 void Layout::save_dynamic(const string &fn) const
442 IO::BufferedFile out(fn, IO::M_WRITE);
443 DataFile::Writer writer(out);
445 const set<Track *> &tracks = objects.get<Track>();
446 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
447 if(unsigned tid = (*i)->get_turnout_id())
448 writer.write((DataFile::Statement("turnout"), tid, (*i)->get_active_path()));
450 for(map<unsigned, Train *>::const_iterator i=trains.begin(); i!=trains.end(); ++i)
452 DataFile::Statement st("train");
453 st.append(i->second->get_locomotive_type().get_article_number());
454 st.append(i->second->get_address());
455 st.append(i->second->get_protocol());
456 i->second->save(st.sub);
461 void Layout::sensor_state_changed(Sensor &sensor, Sensor::State state)
463 if(state==Sensor::ACTIVE)
465 Block *block = sensor.get_block();
466 if(block && !block->get_train())
467 emergency(format("Unreserved sensor %d triggered", sensor.get_address()));
473 Layout::Storage<B>::~Storage()
476 delete *base.begin();
480 bool Layout::Storage<B>::insert(B &b)
482 bool result = base.insert(&b).second;
489 bool Layout::Storage<B>::erase(B &b)
491 bool result = base.erase(&b);
499 const set<T *> &Layout::Storage<B>::get() const
501 for(list<Variant>::const_iterator i=caches.begin(); i!=caches.end(); ++i)
502 if(i->check_type<set<T *> >())
503 return i->value<set<T *> >();
505 caches.push_back(set<T *>());
506 set<T *> &result = caches.back().value<set<T *> >();
507 for(typename set<B *>::const_iterator i=base.begin(); i!=base.end(); ++i)
508 if(T *t = dynamic_cast<T *>(*i))
516 void Layout::Storage<B>::del()
518 set<T *> ts = get<T>();
519 for(typename set<T *>::iterator i=ts.begin(); i!=ts.end(); ++i)
525 Layout::Loader::Loader(Layout &l):
526 DataFile::ObjectLoader<Layout>(l),
529 add("base", &Layout::base);
530 add("beamgate", &Loader::beamgate);
531 add("route", &Loader::route);
532 add("signal", &Loader::signal);
533 add("track", &Loader::track);
534 add("train", &Loader::train);
535 add("turnout", &Loader::turnout);
536 add("zone", &Loader::zone);
539 void Layout::Loader::beamgate()
541 BeamGate *gate = new BeamGate(obj);
545 void Layout::Loader::route()
547 Route *rte = new Route(obj);
551 void Layout::Loader::signal(ArticleNumber art_nr)
553 Signal *sig = new Signal(obj, obj.catalogue.get_signal(art_nr));
557 void Layout::Loader::track(ArticleNumber art_nr)
559 Track *trk = new Track(obj, obj.catalogue.get_track(art_nr));
562 const set<Track *> &tracks = obj.objects.get<Track>();
563 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
568 void Layout::Loader::train(ArticleNumber art_nr, unsigned addr, const std::string &proto)
570 Train *trn = new Train(obj, obj.catalogue.get_vehicle(art_nr), addr, proto);
574 void Layout::Loader::turnout(unsigned addr, unsigned path)
577 obj.driver->set_turnout(addr, path);
580 void Layout::Loader::zone()
582 Zone *zne = new Zone(obj);