2 #include <msp/core/refptr.h>
3 #include <msp/datafile/parser.h>
4 #include <msp/datafile/writer.h>
5 #include <msp/io/print.h>
6 #include <msp/time/utils.h>
13 #include "tracktype.h"
15 #include "vehicletype.h"
23 bool zone_order(const R2C2::Zone *z1, const R2C2::Zone *z2)
25 return z1->get_number()<z2->get_number();
33 Layout::Layout(Catalogue &c, Driver *d):
36 next_turnout_id(0x800)
44 while(!trains.empty())
45 delete trains.begin()->second;
46 while(!routes.empty())
47 delete *routes.begin();
49 delete *zones.begin();
50 while(!tracks.empty())
51 delete *tracks.begin();
52 while(!blocks.empty())
53 delete *blocks.begin();
56 Driver &Layout::get_driver() const
59 throw InvalidState("No driver");
63 void Layout::add_track(Track &t)
65 if(tracks.insert(&t).second)
68 signal_track_added.emit(t);
72 void Layout::remove_track(Track &t)
77 signal_track_removed.emit(t);
81 Track *Layout::pick_track(const Vector &start, const Vector &ray)
83 for(set<Track *>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
84 if((*i)->collide_ray(start, ray))
90 unsigned Layout::allocate_turnout_id()
92 set<unsigned> used_ids;
93 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
94 if((*i)->get_turnout_id())
95 used_ids.insert((*i)->get_turnout_id());
97 unsigned result = next_turnout_id;
98 while(used_ids.count(result))
100 next_turnout_id = result+1;
105 void Layout::add_block(Block &b)
108 b.signal_reserved.connect(sigc::bind<0>(signal_block_reserved, sigc::ref(b)));
109 if(b.get_sensor_id())
111 b.signal_state_changed.connect(sigc::bind<0>(sigc::mem_fun(this, &Layout::block_state_changed), sigc::ref(b)));
112 b.signal_state_changed.connect(sigc::bind<0>(signal_block_state_changed, sigc::ref(b)));
116 Block &Layout::get_block(unsigned id) const
118 for(set<Block *>::const_iterator i=blocks.begin(); i!=blocks.end(); ++i)
119 if((*i)->get_id()==id)
122 throw KeyError("Unknown block", lexical_cast(id));
125 void Layout::create_blocks()
127 set<Track *> used_tracks;
128 for(set<Block *>::const_iterator i=blocks.begin(); i!=blocks.end(); ++i)
130 const set<Track *> &btracks = (*i)->get_tracks();
131 used_tracks.insert(btracks.begin(), btracks.end());
134 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
135 if(used_tracks.count(*i)==0)
137 Block *block = new Block(*this, **i);
138 used_tracks.insert(block->get_tracks().begin(), block->get_tracks().end());
141 for(set<Block *>::iterator i=blocks.begin(); i!=blocks.end(); ++i)
142 for(set<Block *>::iterator j=i; j!=blocks.end(); ++j)
144 (*i)->check_link(**j);
147 void Layout::create_blocks(Track &track)
149 /* Must collect the blocks in a set first while all tracks are still
150 guaranteed to have blocks and to avoid duplicate deletes */
151 set<Block *> del_blocks;
153 del_blocks.insert(&track.get_block());
155 const vector<Track *> &links = track.get_links();
156 for(vector<Track *>::const_iterator i=links.begin(); i!=links.end(); ++i)
158 del_blocks.insert(&(*i)->get_block());
160 for(set<Block *>::iterator i=del_blocks.begin(); i!=del_blocks.end(); ++i)
166 void Layout::remove_block(Block &b)
171 void Layout::add_route(Route &r)
173 if(routes.insert(&r).second)
174 signal_route_added.emit(r);
177 Route &Layout::get_route(const string &name) const
179 for(set<Route *>::const_iterator i=routes.begin(); i!=routes.end(); ++i)
180 if((*i)->get_name()==name)
182 throw KeyError("Unknown route", name);
185 void Layout::update_routes()
187 for(set<Route *>::iterator i=routes.begin(); i!=routes.end(); ++i)
188 (*i)->update_turnouts();
191 void Layout::remove_route(Route &r)
194 signal_route_removed.emit(r);
197 void Layout::add_zone(Zone &z)
199 if(zones.insert(&z).second)
200 signal_zone_added.emit(z);
203 Layout::ZoneArray Layout::get_zones(const string &group) const
206 for(ZoneSet::const_iterator i=zones.begin(); i!=zones.end(); ++i)
207 if((*i)->get_group()==group)
208 result.push_back(*i);
210 sort(result.begin(), result.end(), zone_order);
215 Zone &Layout::get_zone(const string &group, unsigned num) const
217 for(ZoneSet::const_iterator i=zones.begin(); i!=zones.end(); ++i)
218 if((*i)->get_group()==group && (*i)->get_number()==num)
221 throw KeyError("Unknown zone", format("%s %d", group, num));
224 void Layout::remove_zone(Zone &z)
227 signal_zone_removed.emit(z);
230 void Layout::add_train(Train &t)
232 if(trains.count(t.get_address()))
233 throw KeyError("Duplicate train address", lexical_cast(t.get_address()));
235 trains[t.get_address()] = &t;
236 signal_train_added.emit(t);
239 Train &Layout::get_train(unsigned addr) const
241 map<unsigned, Train *>::const_iterator i = trains.find(addr);
243 throw KeyError("Unknown train", lexical_cast(addr));
247 void Layout::remove_train(Train &t)
249 if(trains.erase(t.get_address()))
250 signal_train_removed.emit(t);
253 void Layout::add_vehicle(Vehicle &v)
255 if(vehicles.insert(&v).second)
256 signal_vehicle_added.emit(v);
259 void Layout::remove_vehicle(Vehicle &v)
261 if(vehicles.erase(&v))
262 signal_vehicle_removed.emit(v);
270 Time::TimeStamp t = Time::now();
276 for(set<Block *>::iterator i=blocks.begin(); i!=blocks.end(); ++i)
278 for(map<unsigned, Train *>::iterator i=trains.begin(); i!=trains.end(); ++i)
279 i->second->tick(t, dt);
282 void Layout::emergency(const string &msg)
286 IO::print("Emergency: %s\n", msg);
287 signal_emergency.emit(msg);
290 void Layout::save(const string &fn) const
292 IO::BufferedFile out(fn, IO::M_WRITE);
293 DataFile::Writer writer(out);
296 writer.write((DataFile::Statement("base"), base));
298 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
300 DataFile::Statement st("track");
301 st.append((*i)->get_type().get_article_number());
306 for(set<Route *>::const_iterator i=routes.begin(); i!=routes.end(); ++i)
308 if((*i)->is_temporary())
311 DataFile::Statement st("route");
316 for(ZoneSet::const_iterator i=zones.begin(); i!=zones.end(); ++i)
318 DataFile::Statement st("zone");
324 void Layout::save_dynamic(const string &fn) const
326 IO::BufferedFile out(fn, IO::M_WRITE);
327 DataFile::Writer writer(out);
329 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
330 if(unsigned tid = (*i)->get_turnout_id())
331 writer.write((DataFile::Statement("turnout"), tid, (*i)->get_active_path()));
333 for(map<unsigned, Train *>::const_iterator i=trains.begin(); i!=trains.end(); ++i)
335 DataFile::Statement st("train");
336 st.append(i->second->get_locomotive_type().get_article_number());
337 st.append(i->second->get_address());
338 st.append(i->second->get_protocol());
339 i->second->save(st.sub);
344 void Layout::block_state_changed(Block &block, Block::State state)
346 if(state==Block::ACTIVE && !block.get_train())
347 emergency(format("Unreserved sensor %d triggered", block.get_sensor_id()));
351 Layout::Loader::Loader(Layout &l):
352 DataFile::BasicLoader<Layout>(l),
355 add("base", &Layout::base);
356 add("route", static_cast<void (Loader::*)()>(&Loader::route));
357 add("track", static_cast<void (Loader::*)(ArticleNumber)>(&Loader::track));
358 add("train", static_cast<void (Loader::*)(ArticleNumber, unsigned, const std::string &)>(&Loader::train));
359 add("turnout", &Loader::turnout);
360 add("zone", &Loader::zone);
362 // Deprecated aliases
363 add("route", static_cast<void (Loader::*)(const string &)>(&Loader::route));
364 add("track", static_cast<void (Loader::*)(unsigned)>(&Loader::track));
365 add("train", static_cast<void (Loader::*)(unsigned, unsigned, const std::string &)>(&Loader::train));
368 void Layout::Loader::finish()
370 for(set<Track *>::iterator i=obj.tracks.begin(); i!=obj.tracks.end(); ++i)
374 void Layout::Loader::route()
376 Route *rte = new Route(obj);
380 void Layout::Loader::route(const string &n)
382 Route *rte = new Route(obj);
387 void Layout::Loader::track(unsigned art_nr)
389 track(ArticleNumber(art_nr));
392 void Layout::Loader::track(ArticleNumber art_nr)
394 Track *trk = new Track(obj, obj.catalogue.get_track(art_nr));
397 for(set<Track *>::iterator i=obj.tracks.begin(); i!=obj.tracks.end(); ++i)
399 trk->snap_to(**i, true);
402 void Layout::Loader::train(unsigned art_nr, unsigned addr, const std::string &proto)
404 train(ArticleNumber(art_nr), addr, proto);
407 void Layout::Loader::train(ArticleNumber art_nr, unsigned addr, const std::string &proto)
409 Train *trn = new Train(obj, obj.catalogue.get_vehicle(art_nr), addr, proto);
413 void Layout::Loader::turnout(unsigned addr, unsigned path)
416 obj.driver->set_turnout(addr, path);
419 void Layout::Loader::zone()
421 Zone *zne = new Zone(obj);