source/libmarklin/layout.cpp

   1 /* $Id$
   2
   3 This file is part of the MSP Märklin suite
   4 Copyright © 2006-2010  Mikkosoft Productions, Mikko Rasa
   5 Distributed under the GPL
   6 */
   7
   8 #include <algorithm>
   9 #include <msp/core/refptr.h>
  10 #include <msp/datafile/parser.h>
  11 #include <msp/datafile/writer.h>
  12 #include <msp/io/print.h>
  13 #include <msp/time/utils.h>
  14 #include "block.h"
  15 #include "catalogue.h"
  16 #include "driver.h"
  17 #include "layout.h"
  18 #include "route.h"
  19 #include "track.h"
  20 #include "tracktype.h"
  21 #include "train.h"
  22 #include "vehicletype.h"
  23
  24 using namespace std;
  25 using namespace Msp;
  26
  27 namespace Marklin {
  28
  29 Layout::Layout(Catalogue &c, Driver *d):
  30         catalogue(c),
  31         driver(d),
  32         next_turnout_id(0x800)
  33 {
  34         if(driver)
  35                 driver->signal_sensor.connect(sigc::mem_fun(this, &Layout::sensor_event));
  36 }
  37
  38 Layout::~Layout()
  39 {
  40         delete driver;
  41         while(!trains.empty())
  42                 delete trains.begin()->second;
  43         while(!routes.empty())
  44                 delete routes.begin()->second;
  45         while(!tracks.empty())
  46                 delete *tracks.begin();
  47         while(!blocks.empty())
  48                 delete *blocks.begin();
  49 }
  50
  51 Driver &Layout::get_driver() const
  52 {
  53         if(!driver)
  54                 throw InvalidState("No driver");
  55         return *driver;
  56 }
  57
  58 void Layout::add_track(Track &t)
  59 {
  60         if(tracks.insert(&t).second)
  61         {
  62                 create_blocks();
  63                 signal_track_added.emit(t);
  64         }
  65 }
  66
  67 void Layout::remove_track(Track &t)
  68 {
  69         if(tracks.erase(&t))
  70         {
  71                 create_blocks(t);
  72                 signal_track_removed.emit(t);
  73         }
  74 }
  75
  76 unsigned Layout::allocate_turnout_id()
  77 {
  78         return next_turnout_id++;
  79 }
  80
  81 void Layout::add_block(Block &b)
  82 {
  83         blocks.insert(&b);
  84 }
  85
  86 Block &Layout::get_block(unsigned id) const
  87 {
  88         for(set<Block *>::const_iterator i=blocks.begin(); i!=blocks.end(); ++i)
  89                 if((*i)->get_id()==id)
  90                         return **i;
  91
  92         throw KeyError("Unknown block", lexical_cast(id));
  93 }
  94
  95 Block &Layout::get_block_by_track(const Track &t) const
  96 {
  97         for(set<Block *>::const_iterator i=blocks.begin(); i!=blocks.end(); ++i)
  98                 if((*i)->get_tracks().count(const_cast<Track *>(&t)))
  99                         return **i;
 100
 101         throw InvalidParameterValue("No block found for track");
 102 }
 103
 104 void Layout::create_blocks()
 105 {
 106         set<Track *> used_tracks;
 107         for(set<Block *>::const_iterator i=blocks.begin(); i!=blocks.end(); ++i)
 108         {
 109                 const set<Track *> &btracks = (*i)->get_tracks();
 110                 used_tracks.insert(btracks.begin(), btracks.end());
 111         }
 112
 113         for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
 114                 if(used_tracks.count(*i)==0)
 115                 {
 116                         Block *block = new Block(*this, **i);
 117                         used_tracks.insert(block->get_tracks().begin(), block->get_tracks().end());
 118                 }
 119
 120         for(set<Block *>::iterator i=blocks.begin(); i!=blocks.end(); ++i)
 121                 for(set<Block *>::iterator j=i; j!=blocks.end(); ++j)
 122                         if(j!=i)
 123                                 (*i)->check_link(**j);
 124 }
 125
 126 void Layout::create_blocks(const Track &track)
 127 {
 128         const vector<Track *> &links = track.get_links();
 129         for(set<Block *>::iterator i=blocks.begin(); i!=blocks.end();)
 130         {
 131                 bool del = (*i)->get_tracks().count(const_cast<Track *>(&track));
 132                 for(vector<Track *>::const_iterator j=links.begin(); (!del && j!=links.end()); ++j)
 133                         del = (*i)->get_tracks().count(*j);
 134
 135                 if(del)
 136                         delete *i++;
 137                 else
 138                         ++i;
 139         }
 140
 141         create_blocks();
 142 }
 143
 144 void Layout::remove_block(Block &b)
 145 {
 146         blocks.erase(&b);
 147 }
 148
 149 void Layout::add_route(Route &r)
 150 {
 151         if(routes.count(r.get_name()))
 152                 throw KeyError("Duplicate route name", r.get_name());
 153
 154         routes[r.get_name()] = &r;
 155         signal_route_added.emit(r);
 156 }
 157
 158 Route &Layout::get_route(const string &name) const
 159 {
 160         map<string, Route *>::const_iterator i = routes.find(name);
 161         if(i==routes.end())
 162                 throw KeyError("Unknown route", name);
 163         return *i->second;
 164 }
 165
 166 void Layout::update_routes()
 167 {
 168         for(map<string, Route *>::iterator i=routes.begin(); i!=routes.end(); ++i)
 169                 i->second->update_turnouts();
 170 }
 171
 172 void Layout::remove_route(Route &r)
 173 {
 174         if(routes.erase(r.get_name()))
 175                 signal_route_removed.emit(r);
 176 }
 177
 178 void Layout::add_train(Train &t)
 179 {
 180         if(trains.count(t.get_address()))
 181                 throw KeyError("Duplicate train address", lexical_cast(t.get_address()));
 182
 183         trains[t.get_address()] = &t;
 184         signal_train_added.emit(t);
 185 }
 186
 187 Train &Layout::get_train(unsigned addr) const
 188 {
 189         map<unsigned, Train *>::const_iterator i = trains.find(addr);
 190         if(i==trains.end())
 191                 throw KeyError("Unknown train", lexical_cast(addr));
 192         return *i->second;
 193 }
 194
 195 void Layout::remove_train(Train &t)
 196 {
 197         if(trains.erase(t.get_address()))
 198                 signal_train_removed.emit(t);
 199 }
 200
 201 void Layout::add_vehicle(Vehicle &v)
 202 {
 203         if(vehicles.insert(&v).second)
 204                 signal_vehicle_added.emit(v);
 205 }
 206
 207 void Layout::remove_vehicle(Vehicle &v)
 208 {
 209         if(vehicles.erase(&v))
 210                 signal_vehicle_removed.emit(v);
 211 }
 212
 213 void Layout::tick()
 214 {
 215         if(driver)
 216                 driver->tick();
 217
 218         Time::TimeStamp t = Time::now();
 219         Time::TimeDelta dt;
 220         if(last_tick)
 221                 dt = t-last_tick;
 222         last_tick = t;
 223
 224         for(map<unsigned, Train *>::iterator i=trains.begin(); i!=trains.end(); ++i)
 225                 i->second->tick(t, dt);
 226 }
 227
 228 void Layout::emergency(const string &msg)
 229 {
 230         if(driver)
 231                 driver->halt(true);
 232         IO::print("Emergency: %s\n", msg);
 233         signal_emergency.emit(msg);
 234 }
 235
 236 void Layout::save(const string &fn)
 237 {
 238         IO::BufferedFile out(fn, IO::M_WRITE);
 239         DataFile::Writer writer(out);
 240
 241         if(!base.empty())
 242                 writer.write((DataFile::Statement("base"), base));
 243
 244         for(set<Track *>::iterator i=tracks.begin(); i!=tracks.end(); ++i)
 245         {
 246                 DataFile::Statement st("track");
 247                 st.append((*i)->get_type().get_article_number());
 248                 (*i)->save(st.sub);
 249                 writer.write(st);
 250         }
 251
 252         for(map<string, Route *>::iterator i=routes.begin(); i!=routes.end(); ++i)
 253         {
 254                 if(i->second->is_temporary())
 255                         continue;
 256
 257                 DataFile::Statement st("route");
 258                 st.append(i->first);
 259                 i->second->save(st.sub);
 260                 writer.write(st);
 261         }
 262 }
 263
 264 void Layout::save_trains(const string &fn)
 265 {
 266         IO::BufferedFile out(fn, IO::M_WRITE);
 267         DataFile::Writer writer(out);
 268
 269         for(map<unsigned, Train *>::const_iterator i=trains.begin(); i!=trains.end(); ++i)
 270         {
 271                 DataFile::Statement st("train");
 272                 st.append(i->second->get_locomotive_type().get_article_number());
 273                 st.append(i->second->get_address());
 274                 i->second->save(st.sub);
 275                 writer.write(st);
 276         }
 277 }
 278
 279 void Layout::sensor_event(unsigned addr, bool state)
 280 {
 281         if(state)
 282         {
 283                 for(set<Block *>::iterator i=blocks.begin(); i!=blocks.end(); ++i)
 284                         if((*i)->get_sensor_id()==addr)
 285                         {
 286                                 if(!(*i)->get_train())
 287                                         emergency(format("Unreserved sensor %d triggered", addr));
 288                                 break;
 289                         }
 290         }
 291 }
 292
 293
 294 Layout::Loader::Loader(Layout &l):
 295         DataFile::BasicLoader<Layout>(l),
 296         new_tracks(false)
 297 {
 298         add("base",  &Layout::base);
 299         add("route", &Loader::route);
 300         add("track", &Loader::track);
 301         add("train", &Loader::train);
 302 }
 303
 304 void Layout::Loader::finish()
 305 {
 306         for(set<Track *>::iterator i=obj.tracks.begin(); i!=obj.tracks.end(); ++i)
 307                 (*i)->check_slope();
 308 }
 309
 310 void Layout::Loader::route(const string &n)
 311 {
 312         Route *rte = new Route(obj, n);
 313         load_sub(*rte);
 314 }
 315
 316 void Layout::Loader::track(unsigned art_nr)
 317 {
 318         Track *trk = new Track(obj, obj.catalogue.get_track(art_nr));
 319         load_sub(*trk);
 320         new_tracks = true;
 321         for(set<Track *>::iterator i=obj.tracks.begin(); i!=obj.tracks.end(); ++i)
 322                 if(*i!=trk)
 323                         trk->snap_to(**i, true);
 324 }
 325
 326 void Layout::Loader::train(unsigned art_nr, unsigned addr)
 327 {
 328         Train *trn = new Train(obj, obj.catalogue.get_vehicle(art_nr), addr);
 329         load_sub(*trn);
 330 }
 331
 332 } // namespace Marklin