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 "tracktype.h"
18 #include "vehicletype.h"
26 bool zone_order(const R2C2::Zone *z1, const R2C2::Zone *z2)
28 return z1->get_number()<z2->get_number();
36 Layout::Layout(Catalogue &c, Driver *d):
39 next_turnout_id(0x800)
47 while(!trains.empty())
48 delete trains.begin()->second;
49 while(!routes.empty())
50 delete *routes.begin();
52 delete *zones.begin();
53 while(!tracks.empty())
54 delete *tracks.begin();
55 while(!blocks.empty())
56 delete *blocks.begin();
59 Driver &Layout::get_driver() const
62 throw logic_error("!driver");
66 void Layout::add_track(Track &t)
68 if(tracks.insert(&t).second)
71 signal_track_added.emit(t);
75 void Layout::remove_track(Track &t)
80 signal_track_removed.emit(t);
84 void Layout::add_signal(Signal &s)
86 if(signals.insert(&s).second)
87 signal_signal_added.emit(s);
90 void Layout::remove_signal(Signal &s)
93 signal_signal_removed.emit(s);
96 Track *Layout::pick_track(const Vector &start, const Vector &ray)
98 for(set<Track *>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
99 if((*i)->collide_ray(start, ray))
105 unsigned Layout::allocate_turnout_id()
107 set<unsigned> used_ids;
108 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
109 if((*i)->get_turnout_id())
110 used_ids.insert((*i)->get_turnout_id());
112 unsigned result = next_turnout_id;
113 while(used_ids.count(result))
115 next_turnout_id = result+1;
120 void Layout::add_block(Block &b)
123 b.signal_reserved.connect(sigc::bind<0>(signal_block_reserved, sigc::ref(b)));
124 if(b.get_sensor_id())
126 b.signal_state_changed.connect(sigc::bind<0>(sigc::mem_fun(this, &Layout::block_state_changed), sigc::ref(b)));
127 b.signal_state_changed.connect(sigc::bind<0>(signal_block_state_changed, sigc::ref(b)));
131 Block &Layout::get_block(unsigned id) const
133 for(set<Block *>::const_iterator i=blocks.begin(); i!=blocks.end(); ++i)
134 if((*i)->get_id()==id)
140 void Layout::create_blocks()
142 set<Track *> used_tracks;
143 for(set<Block *>::const_iterator i=blocks.begin(); i!=blocks.end(); ++i)
145 const set<Track *> &btracks = (*i)->get_tracks();
146 used_tracks.insert(btracks.begin(), btracks.end());
149 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
150 if(used_tracks.count(*i)==0)
152 Block *block = new Block(*this, **i);
153 used_tracks.insert(block->get_tracks().begin(), block->get_tracks().end());
156 for(set<Block *>::iterator i=blocks.begin(); i!=blocks.end(); ++i)
157 for(set<Block *>::iterator j=i; j!=blocks.end(); ++j)
159 (*i)->check_link(**j);
162 void Layout::create_blocks(Track &track)
164 /* Must collect the blocks in a set first while all tracks are still
165 guaranteed to have blocks and to avoid duplicate deletes */
166 set<Block *> del_blocks;
168 del_blocks.insert(&track.get_block());
170 const vector<Track *> &links = track.get_links();
171 for(vector<Track *>::const_iterator i=links.begin(); i!=links.end(); ++i)
173 del_blocks.insert(&(*i)->get_block());
175 for(set<Block *>::iterator i=del_blocks.begin(); i!=del_blocks.end(); ++i)
181 void Layout::remove_block(Block &b)
186 void Layout::add_route(Route &r)
188 if(routes.insert(&r).second)
189 signal_route_added.emit(r);
192 Route &Layout::get_route(const string &name) const
194 for(set<Route *>::const_iterator i=routes.begin(); i!=routes.end(); ++i)
195 if((*i)->get_name()==name)
197 throw key_error(name);
200 void Layout::update_routes()
202 for(set<Route *>::iterator i=routes.begin(); i!=routes.end(); ++i)
203 (*i)->update_turnouts();
206 void Layout::remove_route(Route &r)
209 signal_route_removed.emit(r);
212 void Layout::add_zone(Zone &z)
214 if(zones.insert(&z).second)
215 signal_zone_added.emit(z);
218 Layout::ZoneArray Layout::get_zones(const string &group) const
221 for(ZoneSet::const_iterator i=zones.begin(); i!=zones.end(); ++i)
222 if((*i)->get_group()==group)
223 result.push_back(*i);
225 sort(result.begin(), result.end(), zone_order);
230 Zone &Layout::get_zone(const string &group, unsigned num) const
232 for(ZoneSet::const_iterator i=zones.begin(); i!=zones.end(); ++i)
233 if((*i)->get_group()==group && (*i)->get_number()==num)
236 throw key_error(format("%s %d", group, num));
239 void Layout::remove_zone(Zone &z)
242 signal_zone_removed.emit(z);
245 void Layout::add_train(Train &t)
247 insert_unique(trains, t.get_address(), &t);
248 signal_train_added.emit(t);
251 Train &Layout::get_train(unsigned addr) const
253 return *get_item(trains, addr);
256 void Layout::remove_train(Train &t)
258 if(trains.erase(t.get_address()))
259 signal_train_removed.emit(t);
262 void Layout::add_vehicle(Vehicle &v)
264 if(vehicles.insert(&v).second)
265 signal_vehicle_added.emit(v);
268 void Layout::remove_vehicle(Vehicle &v)
270 if(vehicles.erase(&v))
271 signal_vehicle_removed.emit(v);
279 Time::TimeStamp t = Time::now();
285 for(set<Block *>::iterator i=blocks.begin(); i!=blocks.end(); ++i)
287 for(set<Signal *>::iterator i=signals.begin(); i!=signals.end(); ++i)
289 for(map<unsigned, Train *>::iterator i=trains.begin(); i!=trains.end(); ++i)
290 i->second->tick(t, dt);
293 void Layout::emergency(const string &msg)
297 IO::print("Emergency: %s\n", msg);
298 signal_emergency.emit(msg);
301 void Layout::save(const string &fn) const
303 IO::BufferedFile out(fn, IO::M_WRITE);
304 DataFile::Writer writer(out);
307 writer.write((DataFile::Statement("base"), base));
309 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
311 DataFile::Statement st("track");
312 st.append((*i)->get_type().get_article_number());
317 for(set<Signal *>::const_iterator i=signals.begin(); i!=signals.end(); ++i)
319 DataFile::Statement st("signal");
320 st.append((*i)->get_type().get_article_number());
325 for(set<Route *>::const_iterator i=routes.begin(); i!=routes.end(); ++i)
327 if((*i)->is_temporary())
330 DataFile::Statement st("route");
335 for(ZoneSet::const_iterator i=zones.begin(); i!=zones.end(); ++i)
337 DataFile::Statement st("zone");
343 void Layout::save_dynamic(const string &fn) const
345 IO::BufferedFile out(fn, IO::M_WRITE);
346 DataFile::Writer writer(out);
348 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
349 if(unsigned tid = (*i)->get_turnout_id())
350 writer.write((DataFile::Statement("turnout"), tid, (*i)->get_active_path()));
352 for(map<unsigned, Train *>::const_iterator i=trains.begin(); i!=trains.end(); ++i)
354 DataFile::Statement st("train");
355 st.append(i->second->get_locomotive_type().get_article_number());
356 st.append(i->second->get_address());
357 st.append(i->second->get_protocol());
358 i->second->save(st.sub);
363 void Layout::block_state_changed(Block &block, Block::State state)
365 if(state==Block::ACTIVE && !block.get_train())
366 emergency(format("Unreserved sensor %d triggered", block.get_sensor_id()));
370 Layout::Loader::Loader(Layout &l):
371 DataFile::ObjectLoader<Layout>(l),
374 add("base", &Layout::base);
375 add("route", static_cast<void (Loader::*)()>(&Loader::route));
376 add("signal", &Loader::signal);
377 add("track", static_cast<void (Loader::*)(ArticleNumber)>(&Loader::track));
378 add("train", static_cast<void (Loader::*)(ArticleNumber, unsigned, const std::string &)>(&Loader::train));
379 add("turnout", &Loader::turnout);
380 add("zone", &Loader::zone);
382 // Deprecated aliases
383 add("route", static_cast<void (Loader::*)(const string &)>(&Loader::route));
384 add("track", static_cast<void (Loader::*)(unsigned)>(&Loader::track));
385 add("train", static_cast<void (Loader::*)(unsigned, unsigned, const std::string &)>(&Loader::train));
388 void Layout::Loader::finish()
390 for(set<Track *>::iterator i=obj.tracks.begin(); i!=obj.tracks.end(); ++i)
394 void Layout::Loader::route()
396 Route *rte = new Route(obj);
400 void Layout::Loader::route(const string &n)
402 Route *rte = new Route(obj);
407 void Layout::Loader::signal(ArticleNumber art_nr)
409 Signal *sig = new Signal(obj, obj.catalogue.get_signal(art_nr));
413 void Layout::Loader::track(unsigned art_nr)
415 track(ArticleNumber(art_nr));
418 void Layout::Loader::track(ArticleNumber art_nr)
420 Track *trk = new Track(obj, obj.catalogue.get_track(art_nr));
423 for(set<Track *>::iterator i=obj.tracks.begin(); i!=obj.tracks.end(); ++i)
425 trk->snap_to(**i, true);
428 void Layout::Loader::train(unsigned art_nr, unsigned addr, const std::string &proto)
430 train(ArticleNumber(art_nr), addr, proto);
433 void Layout::Loader::train(ArticleNumber art_nr, unsigned addr, const std::string &proto)
435 Train *trn = new Train(obj, obj.catalogue.get_vehicle(art_nr), addr, proto);
439 void Layout::Loader::turnout(unsigned addr, unsigned path)
442 obj.driver->set_turnout(addr, path);
445 void Layout::Loader::zone()
447 Zone *zne = new Zone(obj);