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"
18 #include "trackcircuit.h"
19 #include "tracktype.h"
22 #include "vehicletype.h"
30 bool zone_order(const R2C2::Zone *z1, const R2C2::Zone *z2)
32 return z1->get_number()<z2->get_number();
40 Layout::Layout(Catalogue &c, Driver *d):
43 next_turnout_addr(0x800)
53 while(!trains.empty())
54 delete trains.begin()->second;
55 track_chains.del<Route>();
56 track_chains.del<Zone>();
57 objects.del<Signal>();
59 track_chains.del<Block>();
62 Driver &Layout::get_driver() const
65 throw logic_error("!driver");
69 void Layout::add(Object &o)
75 signal_object_added.emit(o);
85 void Layout::add(Track &t)
91 // Blocks must be recreated first
93 signal_object_added.emit(t);
104 void Layout::add(TrackChain &g)
106 if(track_chains.insert(g))
110 signal_track_chain_added.emit(g);
114 track_chains.erase(g);
120 void Layout::add(Block &b)
122 if(track_chains.insert(b))
124 sigc::connection conn = b.signal_reserved.connect(sigc::bind<0>(signal_block_reserved, sigc::ref(b)));
127 signal_track_chain_added.emit(b);
131 track_chains.erase(b);
138 void Layout::add(Sensor &s)
140 if(sensors.insert(s))
142 s.signal_state_changed.connect(sigc::bind<0>(sigc::mem_fun(this, &Layout::sensor_state_changed), sigc::ref(s)));
143 s.signal_state_changed.connect(sigc::bind<0>(signal_sensor_state_changed, sigc::ref(s)));
147 void Layout::add(BeamGate &g)
149 add(static_cast<Object &>(g));
150 add(static_cast<Sensor &>(g));
154 const set<Object *> &Layout::get_all<Object>() const
156 return objects.get();
160 const set<Track *> &Layout::get_all<Track>() const
162 return objects.get<Track>();
166 const set<Signal *> &Layout::get_all<Signal>() const
168 return objects.get<Signal>();
172 const set<Vehicle *> &Layout::get_all<Vehicle>() const
174 return objects.get<Vehicle>();
178 const set<Terrain *> &Layout::get_all<Terrain>() const
180 return objects.get<Terrain>();
184 const set<TrackChain *> &Layout::get_all<TrackChain>() const
186 return track_chains.get();
190 const set<Block *> &Layout::get_all<Block>() const
192 return track_chains.get<Block>();
196 const set<Route *> &Layout::get_all<Route>() const
198 return track_chains.get<Route>();
202 const set<Zone *> &Layout::get_all<Zone>() const
204 return track_chains.get<Zone>();
208 const set<Sensor *> &Layout::get_all<Sensor>() const
210 return sensors.get<Sensor>();
214 const set<TrackCircuit *> &Layout::get_all<TrackCircuit>() const
216 return sensors.get<TrackCircuit>();
220 const set<BeamGate *> &Layout::get_all<BeamGate>() const
222 return sensors.get<BeamGate>();
226 T *Layout::pick(const Ray &ray)
228 const set<Object *> &objs = objects.get();
231 for(set<Object *>::const_iterator i=objs.begin(); i!=objs.end(); ++i)
232 if(T *t = dynamic_cast<T *>(*i))
235 if(t->collide_ray(ray, &d))
236 if(!closest || d<distance)
246 template Object *Layout::pick<Object>(const Ray &);
247 template Track *Layout::pick<Track>(const Ray &);
248 template Signal *Layout::pick<Signal>(const Ray &);
249 template Vehicle *Layout::pick<Vehicle>(const Ray &);
251 void Layout::remove(Object &o)
254 signal_object_removed.emit(o);
257 void Layout::remove(Track &t)
261 // Blocks must be recreated first
263 signal_object_removed.emit(t);
267 void Layout::remove(TrackChain &g)
269 if(track_chains.erase(g))
270 signal_track_chain_removed.emit(g);
273 void Layout::remove(Sensor &s)
278 void Layout::remove(BeamGate &g)
280 remove(static_cast<Object &>(g));
281 remove(static_cast<Sensor &>(g));
284 unsigned Layout::allocate_turnout_address()
286 set<unsigned> used_addrs;
287 const set<Track *> &tracks = objects.get<Track>();
288 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
289 if((*i)->get_type().is_turnout())
290 used_addrs.insert((*i)->get_turnout_address());
292 unsigned result = next_turnout_addr;
293 while(used_addrs.count(result))
295 next_turnout_addr = result+1;
300 Block &Layout::get_block(unsigned id) const
302 const set<Block *> &blocks = track_chains.get<Block>();
303 for(set<Block *>::const_iterator i=blocks.begin(); i!=blocks.end(); ++i)
304 if((*i)->get_id()==id)
310 void Layout::create_blocks()
312 set<Track *> loose_tracks = objects.get<Track>();
313 const set<Block *> *blocks = &track_chains.get<Block>();
314 for(set<Block *>::const_iterator i=blocks->begin(); i!=blocks->end(); ++i)
316 const set<Track *> &btracks = (*i)->get_tracks();
317 for(set<Track *>::const_iterator j=btracks.begin(); j!=btracks.end(); ++j)
318 loose_tracks.erase(*j);
321 list<Block *> created_blocks;
322 while(!loose_tracks.empty())
324 Block *block = new Block(*this, **loose_tracks.begin());
325 created_blocks.push_back(block);
327 const set<Track *> &btracks = block->get_tracks();
328 for(set<Track *>::const_iterator i=btracks.begin(); i!=btracks.end(); ++i)
329 loose_tracks.erase(*i);
332 // The previously obtained set has been invalidated by creating new blocks
333 blocks = &track_chains.get<Block>();
334 for(list<Block *>::iterator i=created_blocks.begin(); i!=created_blocks.end(); ++i)
335 for(set<Block *>::const_iterator j=blocks->begin(); j!=blocks->end(); ++j)
337 (*i)->check_link(**j);
340 void Layout::create_blocks(Track &track)
342 /* Must collect the blocks in a set first while all tracks are still
343 guaranteed to have blocks and to avoid duplicate deletes */
344 set<Block *> del_blocks;
346 del_blocks.insert(&track.get_block());
348 const vector<Track *> &links = track.get_links();
349 for(vector<Track *>::const_iterator i=links.begin(); i!=links.end(); ++i)
351 del_blocks.insert(&(*i)->get_block());
353 for(set<Block *>::iterator i=del_blocks.begin(); i!=del_blocks.end(); ++i)
359 Route &Layout::get_route(const string &name) const
361 const set<Route *> &routes = track_chains.get<Route>();
362 for(set<Route *>::const_iterator i=routes.begin(); i!=routes.end(); ++i)
363 if((*i)->get_name()==name)
365 throw key_error(name);
368 void Layout::update_routes()
370 const set<Route *> &routes = track_chains.get<Route>();
371 for(set<Route *>::iterator i=routes.begin(); i!=routes.end(); ++i)
372 (*i)->update_turnouts();
375 Layout::ZoneArray Layout::get_zones(const string &group) const
378 const set<Zone *> &zones = track_chains.get<Zone>();
379 for(set<Zone *>::const_iterator i=zones.begin(); i!=zones.end(); ++i)
380 if((*i)->get_group()==group)
381 result.push_back(*i);
383 sort(result.begin(), result.end(), zone_order);
388 Zone &Layout::get_zone(const string &group, unsigned num) const
390 const set<Zone *> &zones = track_chains.get<Zone>();
391 for(set<Zone *>::const_iterator i=zones.begin(); i!=zones.end(); ++i)
392 if((*i)->get_group()==group && (*i)->get_number()==num)
395 throw key_error(format("%s %d", group, num));
398 void Layout::add_train(Train &t)
400 insert_unique(trains, t.get_address(), &t);
401 signal_train_added.emit(t);
404 Train &Layout::get_train(unsigned addr) const
406 return *get_item(trains, addr);
409 void Layout::remove_train(Train &t)
411 if(trains.erase(t.get_address()))
412 signal_train_removed.emit(t);
420 Time::TimeStamp t = Time::now();
426 if(!driver || !driver->is_halted())
429 for(set<Sensor *>::iterator i=sensors.get().begin(); i!=sensors.get().end(); ++i)
431 const set<Signal *> &signals = objects.get<Signal>();
432 for(set<Signal *>::iterator i=signals.begin(); i!=signals.end(); ++i)
434 for(map<unsigned, Train *>::iterator i=trains.begin(); i!=trains.end(); ++i)
438 void Layout::emergency(Block *block, const string &msg)
443 IO::print("Emergency at %s: %s\n", block->get_name(), msg);
445 IO::print("Emergency: %s\n", msg);
446 signal_emergency.emit(block, msg);
449 void Layout::save(const string &fn) const
451 IO::BufferedFile out(fn, IO::M_WRITE);
452 DataFile::Writer writer(out);
455 writer.write((DataFile::Statement("base"), base));
457 const set<Track *> &tracks = objects.get<Track>();
458 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
460 DataFile::Statement st("track");
461 st.append(catalogue.get_name(&(*i)->get_type()));
466 const set<Signal *> &signals = objects.get<Signal>();
467 for(set<Signal *>::const_iterator i=signals.begin(); i!=signals.end(); ++i)
469 DataFile::Statement st("signal");
470 st.append(catalogue.get_name(&(*i)->get_type()));
475 const set<Terrain *> &terrains = objects.get<Terrain>();
476 for(set<Terrain *>::const_iterator i=terrains.begin(); i!=terrains.end(); ++i)
478 DataFile::Statement st("terrain");
479 st.append(catalogue.get_name(&(*i)->get_type()));
484 const set<BeamGate *> &gates = objects.get<BeamGate>();
485 for(set<BeamGate *>::const_iterator i=gates.begin(); i!=gates.end(); ++i)
487 DataFile::Statement st("beamgate");
492 const set<Route *> &routes = track_chains.get<Route>();
493 for(set<Route *>::const_iterator i=routes.begin(); i!=routes.end(); ++i)
495 if((*i)->is_temporary())
498 DataFile::Statement st("route");
503 const set<Zone *> &zones = track_chains.get<Zone>();
504 for(set<Zone *>::const_iterator i=zones.begin(); i!=zones.end(); ++i)
506 DataFile::Statement st("zone");
512 void Layout::save_dynamic(const string &fn) const
514 IO::BufferedFile out(fn, IO::M_WRITE);
515 DataFile::Writer writer(out);
518 DataFile::Statement st("clock");
523 const set<Track *> &tracks = objects.get<Track>();
524 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
525 if((*i)->get_type().is_turnout())
526 writer.write((DataFile::Statement("turnout"), (*i)->get_turnout_address(), (*i)->get_active_path()));
528 for(map<unsigned, Train *>::const_iterator i=trains.begin(); i!=trains.end(); ++i)
530 DataFile::Statement st("train");
531 st.append(catalogue.get_name(&i->second->get_locomotive_type()));
532 st.append(i->second->get_address());
533 st.append(i->second->get_protocol());
534 i->second->save(st.sub);
539 void Layout::sensor_state_changed(Sensor &sensor, Sensor::State state)
541 if(state==Sensor::ACTIVE)
543 Block *block = sensor.get_block();
544 if(block && !block->get_train())
545 emergency(block, "Unreserved sensor triggered");
551 Layout::Storage<B>::~Storage()
554 delete *base.begin();
558 bool Layout::Storage<B>::insert(B &b)
560 bool result = base.insert(&b).second;
567 bool Layout::Storage<B>::erase(B &b)
569 bool result = base.erase(&b);
577 const set<T *> &Layout::Storage<B>::get() const
579 for(list<Variant>::const_iterator i=caches.begin(); i!=caches.end(); ++i)
580 if(i->check_type<set<T *> >())
581 return i->value<set<T *> >();
583 caches.push_back(set<T *>());
584 set<T *> &result = caches.back().value<set<T *> >();
585 for(typename set<B *>::const_iterator i=base.begin(); i!=base.end(); ++i)
586 if(T *t = dynamic_cast<T *>(*i))
594 void Layout::Storage<B>::del()
596 set<T *> ts = get<T>();
597 for(typename set<T *>::iterator i=ts.begin(); i!=ts.end(); ++i)
603 Layout::Loader::Loader(Layout &l):
604 DataFile::ObjectLoader<Layout>(l)
606 add("base", &Layout::base);
607 add("beamgate", &Loader::beamgate);
608 add("clock", &Loader::clock);
609 add("route", &Loader::route);
610 add("signal", &Loader::signal);
611 add("terrain", &Loader::terrain);
612 add("track", &Loader::track);
613 add("train", &Loader::train);
614 add("turnout", &Loader::turnout);
615 add("zone", &Loader::zone);
618 void Layout::Loader::beamgate()
620 BeamGate *gate = new BeamGate(obj);
624 void Layout::Loader::clock()
629 void Layout::Loader::route()
631 Route *rte = new Route(obj);
635 void Layout::Loader::signal(const string &n)
637 Signal *sig = new Signal(obj, obj.catalogue.get<SignalType>(n));
641 void Layout::Loader::terrain(const string &n)
643 Terrain *ter = new Terrain(obj, obj.catalogue.get<TerrainType>(n));
647 void Layout::Loader::track(const string &n)
649 Track *trk = new Track(obj, obj.catalogue.get<TrackType>(n));
651 const set<Track *> &tracks = obj.objects.get<Track>();
652 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
657 void Layout::Loader::train(const string &n, unsigned addr, const std::string &proto)
659 Train *trn = new Train(obj, obj.catalogue.get<VehicleType>(n), addr, proto);
663 void Layout::Loader::turnout(unsigned addr, unsigned path)
666 obj.driver->set_turnout(addr, path);
669 void Layout::Loader::zone()
671 Zone *zne = new Zone(obj);