source/libr2c2/layout.cpp

   1 #include <algorithm>
   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>
   8 #include "block.h"
   9 #include "catalogue.h"
  10 #include "driver.h"
  11 #include "layout.h"
  12 #include "route.h"
  13 #include "signal.h"
  14 #include "signaltype.h"
  15 #include "track.h"
  16 #include "tracktype.h"
  17 #include "train.h"
  18 #include "vehicletype.h"
  19 #include "zone.h"
  20
  21 using namespace std;
  22 using namespace Msp;
  23
  24 namespace {
  25
  26 bool zone_order(const R2C2::Zone *z1, const R2C2::Zone *z2)
  27 {
  28         return z1->get_number()<z2->get_number();
  29 }
  30
  31 }
  32
  33
  34 namespace R2C2 {
  35
  36 Layout::Layout(Catalogue &c, Driver *d):
  37         catalogue(c),
  38         driver(d),
  39         next_turnout_id(0x800)
  40 { }
  41
  42 Layout::~Layout()
  43 {
  44         delete driver;
  45         driver = 0;
  46
  47         while(!trains.empty())
  48                 delete trains.begin()->second;
  49         while(!routes.empty())
  50                 delete *routes.begin();
  51         while(!zones.empty())
  52                 delete *zones.begin();
  53         while(!signals.empty())
  54                 delete *signals.begin();
  55         while(!tracks.empty())
  56                 delete *tracks.begin();
  57         while(!blocks.empty())
  58                 delete *blocks.begin();
  59 }
  60
  61 Driver &Layout::get_driver() const
  62 {
  63         if(!driver)
  64                 throw logic_error("!driver");
  65         return *driver;
  66 }
  67
  68 void Layout::add_track(Track &t)
  69 {
  70         if(tracks.insert(&t).second)
  71         {
  72                 create_blocks();
  73                 signal_track_added.emit(t);
  74         }
  75 }
  76
  77 Track *Layout::pick_track(const Ray &ray)
  78 {
  79         return pick(tracks, ray);
  80 }
  81
  82 void Layout::remove_track(Track &t)
  83 {
  84         if(tracks.erase(&t))
  85         {
  86                 create_blocks(t);
  87                 signal_track_removed.emit(t);
  88         }
  89 }
  90
  91 unsigned Layout::allocate_turnout_id()
  92 {
  93         set<unsigned> used_ids;
  94         for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
  95                 if((*i)->get_turnout_id())
  96                         used_ids.insert((*i)->get_turnout_id());
  97
  98         unsigned result = next_turnout_id;
  99         while(used_ids.count(result))
 100                 ++result;
 101         next_turnout_id = result+1;
 102
 103         return result;
 104 }
 105
 106 void Layout::add_signal(Signal &s)
 107 {
 108         if(signals.insert(&s).second)
 109                 signal_signal_added.emit(s);
 110 }
 111
 112 Signal *Layout::pick_signal(const Ray &ray)
 113 {
 114         return pick(signals, ray);
 115 }
 116
 117 void Layout::remove_signal(Signal &s)
 118 {
 119         if(signals.erase(&s))
 120                 signal_signal_removed.emit(s);
 121 }
 122
 123 Object *Layout::pick_object(const Ray &ray)
 124 {
 125         if(Object *obj = pick_track(ray))
 126                 return obj;
 127         else if((obj = pick_signal(ray)))
 128                 return obj;
 129         return 0;
 130 }
 131
 132 template<typename T>
 133 T *Layout::pick(const set<T *> &objs, const Ray &ray)
 134 {
 135         for(typename set<T *>::const_iterator i=objs.begin(); i!=objs.end(); ++i)
 136                 if((*i)->collide_ray(ray))
 137                         return *i;
 138
 139         return 0;
 140 }
 141
 142 void Layout::add_block(Block &b)
 143 {
 144         blocks.insert(&b);
 145         b.signal_reserved.connect(sigc::bind<0>(signal_block_reserved, sigc::ref(b)));
 146         if(b.get_sensor_id())
 147         {
 148                 b.signal_state_changed.connect(sigc::bind<0>(sigc::mem_fun(this, &Layout::block_state_changed), sigc::ref(b)));
 149                 b.signal_state_changed.connect(sigc::bind<0>(signal_block_state_changed, sigc::ref(b)));
 150         }
 151 }
 152
 153 Block &Layout::get_block(unsigned id) const
 154 {
 155         for(set<Block *>::const_iterator i=blocks.begin(); i!=blocks.end(); ++i)
 156                 if((*i)->get_id()==id)
 157                         return **i;
 158
 159         throw key_error(id);
 160 }
 161
 162 void Layout::create_blocks()
 163 {
 164         set<Track *> used_tracks;
 165         for(set<Block *>::const_iterator i=blocks.begin(); i!=blocks.end(); ++i)
 166         {
 167                 const set<Track *> &btracks = (*i)->get_tracks();
 168                 used_tracks.insert(btracks.begin(), btracks.end());
 169         }
 170
 171         for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
 172                 if(used_tracks.count(*i)==0)
 173                 {
 174                         Block *block = new Block(*this, **i);
 175                         used_tracks.insert(block->get_tracks().begin(), block->get_tracks().end());
 176                 }
 177
 178         for(set<Block *>::iterator i=blocks.begin(); i!=blocks.end(); ++i)
 179                 for(set<Block *>::iterator j=i; j!=blocks.end(); ++j)
 180                         if(j!=i)
 181                                 (*i)->check_link(**j);
 182 }
 183
 184 void Layout::create_blocks(Track &track)
 185 {
 186         /* Must collect the blocks in a set first while all tracks are still
 187         guaranteed to have blocks and to avoid duplicate deletes */
 188         set<Block *> del_blocks;
 189
 190         del_blocks.insert(&track.get_block());
 191
 192         const vector<Track *> &links = track.get_links();
 193         for(vector<Track *>::const_iterator i=links.begin(); i!=links.end(); ++i)
 194                 if(*i)
 195                         del_blocks.insert(&(*i)->get_block());
 196
 197         for(set<Block *>::iterator i=del_blocks.begin(); i!=del_blocks.end(); ++i)
 198                 delete *i;
 199
 200         create_blocks();
 201 }
 202
 203 void Layout::remove_block(Block &b)
 204 {
 205         blocks.erase(&b);
 206 }
 207
 208 void Layout::add_route(Route &r)
 209 {
 210         if(routes.insert(&r).second)
 211                 signal_route_added.emit(r);
 212 }
 213
 214 Route &Layout::get_route(const string &name) const
 215 {
 216         for(set<Route *>::const_iterator i=routes.begin(); i!=routes.end(); ++i)
 217                 if((*i)->get_name()==name)
 218                         return **i;
 219         throw key_error(name);
 220 }
 221
 222 void Layout::update_routes()
 223 {
 224         for(set<Route *>::iterator i=routes.begin(); i!=routes.end(); ++i)
 225                 (*i)->update_turnouts();
 226 }
 227
 228 void Layout::remove_route(Route &r)
 229 {
 230         if(routes.erase(&r))
 231                 signal_route_removed.emit(r);
 232 }
 233
 234 void Layout::add_zone(Zone &z)
 235 {
 236         if(zones.insert(&z).second)
 237                 signal_zone_added.emit(z);
 238 }
 239
 240 Layout::ZoneArray Layout::get_zones(const string &group) const
 241 {
 242         ZoneArray result;
 243         for(ZoneSet::const_iterator i=zones.begin(); i!=zones.end(); ++i)
 244                 if((*i)->get_group()==group)
 245                         result.push_back(*i);
 246
 247         sort(result.begin(), result.end(), zone_order);
 248
 249         return result;
 250 }
 251
 252 Zone &Layout::get_zone(const string &group, unsigned num) const
 253 {
 254         for(ZoneSet::const_iterator i=zones.begin(); i!=zones.end(); ++i)
 255                 if((*i)->get_group()==group && (*i)->get_number()==num)
 256                         return **i;
 257
 258         throw key_error(format("%s %d", group, num));
 259 }
 260
 261 void Layout::remove_zone(Zone &z)
 262 {
 263         if(zones.erase(&z))
 264                 signal_zone_removed.emit(z);
 265 }
 266
 267 void Layout::add_train(Train &t)
 268 {
 269         insert_unique(trains, t.get_address(), &t);
 270         signal_train_added.emit(t);
 271 }
 272
 273 Train &Layout::get_train(unsigned addr) const
 274 {
 275         return *get_item(trains, addr);
 276 }
 277
 278 void Layout::remove_train(Train &t)
 279 {
 280         if(trains.erase(t.get_address()))
 281                 signal_train_removed.emit(t);
 282 }
 283
 284 void Layout::add_vehicle(Vehicle &v)
 285 {
 286         if(vehicles.insert(&v).second)
 287                 signal_vehicle_added.emit(v);
 288 }
 289
 290 void Layout::remove_vehicle(Vehicle &v)
 291 {
 292         if(vehicles.erase(&v))
 293                 signal_vehicle_removed.emit(v);
 294 }
 295
 296 void Layout::tick()
 297 {
 298         if(driver)
 299                 driver->tick();
 300
 301         Time::TimeStamp t = Time::now();
 302         Time::TimeDelta dt;
 303         if(last_tick)
 304                 dt = t-last_tick;
 305         last_tick = t;
 306
 307         for(set<Block *>::iterator i=blocks.begin(); i!=blocks.end(); ++i)
 308                 (*i)->tick(dt);
 309         for(set<Signal *>::iterator i=signals.begin(); i!=signals.end(); ++i)
 310                 (*i)->tick(dt);
 311         for(map<unsigned, Train *>::iterator i=trains.begin(); i!=trains.end(); ++i)
 312                 i->second->tick(t, dt);
 313 }
 314
 315 void Layout::emergency(const string &msg)
 316 {
 317         if(driver)
 318                 driver->halt(true);
 319         IO::print("Emergency: %s\n", msg);
 320         signal_emergency.emit(msg);
 321 }
 322
 323 void Layout::save(const string &fn) const
 324 {
 325         IO::BufferedFile out(fn, IO::M_WRITE);
 326         DataFile::Writer writer(out);
 327
 328         if(!base.empty())
 329                 writer.write((DataFile::Statement("base"), base));
 330
 331         for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
 332         {
 333                 DataFile::Statement st("track");
 334                 st.append((*i)->get_type().get_article_number());
 335                 (*i)->save(st.sub);
 336                 writer.write(st);
 337         }
 338
 339         for(set<Signal *>::const_iterator i=signals.begin(); i!=signals.end(); ++i)
 340         {
 341                 DataFile::Statement st("signal");
 342                 st.append((*i)->get_type().get_article_number());
 343                 (*i)->save(st.sub);
 344                 writer.write(st);
 345         }
 346
 347         for(set<Route *>::const_iterator i=routes.begin(); i!=routes.end(); ++i)
 348         {
 349                 if((*i)->is_temporary())
 350                         continue;
 351
 352                 DataFile::Statement st("route");
 353                 (*i)->save(st.sub);
 354                 writer.write(st);
 355         }
 356
 357         for(ZoneSet::const_iterator i=zones.begin(); i!=zones.end(); ++i)
 358         {
 359                 DataFile::Statement st("zone");
 360                 (*i)->save(st.sub);
 361                 writer.write(st);
 362         }
 363 }
 364
 365 void Layout::save_dynamic(const string &fn) const
 366 {
 367         IO::BufferedFile out(fn, IO::M_WRITE);
 368         DataFile::Writer writer(out);
 369
 370         for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
 371                 if(unsigned tid = (*i)->get_turnout_id())
 372                         writer.write((DataFile::Statement("turnout"), tid, (*i)->get_active_path()));
 373
 374         for(map<unsigned, Train *>::const_iterator i=trains.begin(); i!=trains.end(); ++i)
 375         {
 376                 DataFile::Statement st("train");
 377                 st.append(i->second->get_locomotive_type().get_article_number());
 378                 st.append(i->second->get_address());
 379                 st.append(i->second->get_protocol());
 380                 i->second->save(st.sub);
 381                 writer.write(st);
 382         }
 383 }
 384
 385 void Layout::block_state_changed(Block &block, Block::State state)
 386 {
 387         if(state==Block::ACTIVE && !block.get_train())
 388                 emergency(format("Unreserved sensor %d triggered", block.get_sensor_id()));
 389 }
 390
 391
 392 Layout::Loader::Loader(Layout &l):
 393         DataFile::ObjectLoader<Layout>(l),
 394         new_tracks(false)
 395 {
 396         add("base",  &Layout::base);
 397         add("route", static_cast<void (Loader::*)()>(&Loader::route));
 398         add("signal", &Loader::signal);
 399         add("track", static_cast<void (Loader::*)(ArticleNumber)>(&Loader::track));
 400         add("train", static_cast<void (Loader::*)(ArticleNumber, unsigned, const std::string &)>(&Loader::train));
 401         add("turnout", &Loader::turnout);
 402         add("zone",  &Loader::zone);
 403
 404         // Deprecated aliases
 405         add("route", static_cast<void (Loader::*)(const string &)>(&Loader::route));
 406         add("track", static_cast<void (Loader::*)(unsigned)>(&Loader::track));
 407         add("train", static_cast<void (Loader::*)(unsigned, unsigned, const std::string &)>(&Loader::train));
 408 }
 409
 410 void Layout::Loader::route()
 411 {
 412         Route *rte = new Route(obj);
 413         load_sub(*rte);
 414 }
 415
 416 void Layout::Loader::route(const string &n)
 417 {
 418         Route *rte = new Route(obj);
 419         rte->set_name(n);
 420         load_sub(*rte);
 421 }
 422
 423 void Layout::Loader::signal(ArticleNumber art_nr)
 424 {
 425         Signal *sig = new Signal(obj, obj.catalogue.get_signal(art_nr));
 426         load_sub(*sig);
 427 }
 428
 429 void Layout::Loader::track(unsigned art_nr)
 430 {
 431         track(ArticleNumber(art_nr));
 432 }
 433
 434 void Layout::Loader::track(ArticleNumber art_nr)
 435 {
 436         Track *trk = new Track(obj, obj.catalogue.get_track(art_nr));
 437         load_sub(*trk);
 438         new_tracks = true;
 439         for(set<Track *>::iterator i=obj.tracks.begin(); i!=obj.tracks.end(); ++i)
 440                 if(*i!=trk)
 441                         trk->link_to(**i);
 442 }
 443
 444 void Layout::Loader::train(unsigned art_nr, unsigned addr, const std::string &proto)
 445 {
 446         train(ArticleNumber(art_nr), addr, proto);
 447 }
 448
 449 void Layout::Loader::train(ArticleNumber art_nr, unsigned addr, const std::string &proto)
 450 {
 451         Train *trn = new Train(obj, obj.catalogue.get_vehicle(art_nr), addr, proto);
 452         load_sub(*trn);
 453 }
 454
 455 void Layout::Loader::turnout(unsigned addr, unsigned path)
 456 {
 457         if(obj.driver)
 458                 obj.driver->set_turnout(addr, path);
 459 }
 460
 461 void Layout::Loader::zone()
 462 {
 463         Zone *zne = new Zone(obj);
 464         load_sub(*zne);
 465 }
 466
 467 } // namespace R2C2