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