]> git.tdb.fi Git - r2c2.git/blobdiff - source/libr2c2/layout.cpp
Basic support for beam gate sensors
[r2c2.git] / source / libr2c2 / layout.cpp
index 6db66a62fc99644e2bedf7e85942b67d49e12b5b..b847637fab797481a34225ccf88dea9a2d29ceb4 100644 (file)
@@ -5,6 +5,7 @@
 #include <msp/datafile/writer.h>
 #include <msp/io/print.h>
 #include <msp/time/utils.h>
+#include "beamgate.h"
 #include "block.h"
 #include "catalogue.h"
 #include "driver.h"
@@ -39,7 +40,9 @@ Layout::Layout(Catalogue &c, Driver *d):
        catalogue(c),
        driver(d),
        next_turnout_id(0x800)
-{ }
+{
+       clock.set_rate(60);
+}
 
 Layout::~Layout()
 {
@@ -48,14 +51,11 @@ Layout::~Layout()
 
        while(!trains.empty())
                delete trains.begin()->second;
-       while(!routes.empty())
-               delete *routes.begin();
-       while(!zones.empty())
-               delete *zones.begin();
+       track_chains.del<Route>();
+       track_chains.del<Zone>();
        objects.del<Signal>();
        objects.del<Track>();
-       while(!blocks.empty())
-               delete *blocks.begin();
+       track_chains.del<Block>();
 }
 
 Driver &Layout::get_driver() const
@@ -81,6 +81,36 @@ void Layout::add(Track &t)
        }
 }
 
+void Layout::add(TrackChain &g)
+{
+       if(track_chains.insert(g))
+               signal_track_chain_added.emit(g);
+}
+
+void Layout::add(Block &b)
+{
+       if(track_chains.insert(b))
+       {
+               b.signal_reserved.connect(sigc::bind<0>(signal_block_reserved, sigc::ref(b)));
+               signal_track_chain_added.emit(b);
+       }
+}
+
+void Layout::add(Sensor &s)
+{
+       if(sensors.insert(s))
+       {
+               s.signal_state_changed.connect(sigc::bind<0>(sigc::mem_fun(this, &Layout::sensor_state_changed), sigc::ref(s)));
+               s.signal_state_changed.connect(sigc::bind<0>(signal_sensor_state_changed, sigc::ref(s)));
+       }
+}
+
+void Layout::add(BeamGate &g)
+{
+       add(static_cast<Object &>(g));
+       add(static_cast<Sensor &>(g));
+}
+
 template<>
 const set<Object *> &Layout::get_all<Object>() const
 {
@@ -105,6 +135,48 @@ const set<Vehicle *> &Layout::get_all<Vehicle>() const
        return objects.get<Vehicle>();
 }
 
+template<>
+const set<TrackChain *> &Layout::get_all<TrackChain>() const
+{
+       return track_chains.get();
+}
+
+template<>
+const set<Block *> &Layout::get_all<Block>() const
+{
+       return track_chains.get<Block>();
+}
+
+template<>
+const set<Route *> &Layout::get_all<Route>() const
+{
+       return track_chains.get<Route>();
+}
+
+template<>
+const set<Zone *> &Layout::get_all<Zone>() const
+{
+       return track_chains.get<Zone>();
+}
+
+template<>
+const set<Sensor *> &Layout::get_all<Sensor>() const
+{
+       return sensors.get<Sensor>();
+}
+
+template<>
+const set<TrackCircuit *> &Layout::get_all<TrackCircuit>() const
+{
+       return sensors.get<TrackCircuit>();
+}
+
+template<>
+const set<BeamGate *> &Layout::get_all<BeamGate>() const
+{
+       return sensors.get<BeamGate>();
+}
+
 template<typename T>
 T *Layout::pick(const Ray &ray)
 {
@@ -138,6 +210,23 @@ void Layout::remove(Track &t)
        }
 }
 
+void Layout::remove(TrackChain &g)
+{
+       if(track_chains.erase(g))
+               signal_track_chain_removed.emit(g);
+}
+
+void Layout::remove(Sensor &s)
+{
+       sensors.erase(s);
+}
+
+void Layout::remove(BeamGate &g)
+{
+       remove(static_cast<Object &>(g));
+       remove(static_cast<Sensor &>(g));
+}
+
 unsigned Layout::allocate_turnout_id()
 {
        set<unsigned> used_ids;
@@ -154,14 +243,9 @@ unsigned Layout::allocate_turnout_id()
        return result;
 }
 
-void Layout::add_block(Block &b)
-{
-       blocks.insert(&b);
-       b.signal_reserved.connect(sigc::bind<0>(signal_block_reserved, sigc::ref(b)));
-}
-
 Block &Layout::get_block(unsigned id) const
 {
+       const set<Block *> &blocks = track_chains.get<Block>();
        for(set<Block *>::const_iterator i=blocks.begin(); i!=blocks.end(); ++i)
                if((*i)->get_id()==id)
                        return **i;
@@ -172,7 +256,8 @@ Block &Layout::get_block(unsigned id) const
 void Layout::create_blocks()
 {
        set<Track *> used_tracks;
-       for(set<Block *>::const_iterator i=blocks.begin(); i!=blocks.end(); ++i)
+       const set<Block *> *blocks = &track_chains.get<Block>();
+       for(set<Block *>::const_iterator i=blocks->begin(); i!=blocks->end(); ++i)
        {
                const set<Track *> &btracks = (*i)->get_tracks();
                used_tracks.insert(btracks.begin(), btracks.end());
@@ -186,8 +271,9 @@ void Layout::create_blocks()
                        used_tracks.insert(block->get_tracks().begin(), block->get_tracks().end());
                }
 
-       for(set<Block *>::iterator i=blocks.begin(); i!=blocks.end(); ++i)
-               for(set<Block *>::iterator j=i; j!=blocks.end(); ++j)
+       blocks = &track_chains.get<Block>();
+       for(set<Block *>::iterator i=blocks->begin(); i!=blocks->end(); ++i)
+               for(set<Block *>::iterator j=i; j!=blocks->end(); ++j)
                        if(j!=i)
                                (*i)->check_link(**j);
 }
@@ -211,19 +297,9 @@ void Layout::create_blocks(Track &track)
        create_blocks();
 }
 
-void Layout::remove_block(Block &b)
-{
-       blocks.erase(&b);
-}
-
-void Layout::add_route(Route &r)
-{
-       if(routes.insert(&r).second)
-               signal_route_added.emit(r);
-}
-
 Route &Layout::get_route(const string &name) const
 {
+       const set<Route *> &routes = track_chains.get<Route>();
        for(set<Route *>::const_iterator i=routes.begin(); i!=routes.end(); ++i)
                if((*i)->get_name()==name)
                        return **i;
@@ -232,26 +308,16 @@ Route &Layout::get_route(const string &name) const
 
 void Layout::update_routes()
 {
+       const set<Route *> &routes = track_chains.get<Route>();
        for(set<Route *>::iterator i=routes.begin(); i!=routes.end(); ++i)
                (*i)->update_turnouts();
 }
 
-void Layout::remove_route(Route &r)
-{
-       if(routes.erase(&r))
-               signal_route_removed.emit(r);
-}
-
-void Layout::add_zone(Zone &z)
-{
-       if(zones.insert(&z).second)
-               signal_zone_added.emit(z);
-}
-
 Layout::ZoneArray Layout::get_zones(const string &group) const
 {
        ZoneArray result;
-       for(ZoneSet::const_iterator i=zones.begin(); i!=zones.end(); ++i)
+       const set<Zone *> &zones = track_chains.get<Zone>();
+       for(set<Zone *>::const_iterator i=zones.begin(); i!=zones.end(); ++i)
                if((*i)->get_group()==group)
                        result.push_back(*i);
 
@@ -262,19 +328,14 @@ Layout::ZoneArray Layout::get_zones(const string &group) const
 
 Zone &Layout::get_zone(const string &group, unsigned num) const
 {
-       for(ZoneSet::const_iterator i=zones.begin(); i!=zones.end(); ++i)
+       const set<Zone *> &zones = track_chains.get<Zone>();
+       for(set<Zone *>::const_iterator i=zones.begin(); i!=zones.end(); ++i)
                if((*i)->get_group()==group && (*i)->get_number()==num)
                        return **i;
 
        throw key_error(format("%s %d", group, num));
 }
 
-void Layout::remove_zone(Zone &z)
-{
-       if(zones.erase(&z))
-               signal_zone_removed.emit(z);
-}
-
 void Layout::add_train(Train &t)
 {
        insert_unique(trains, t.get_address(), &t);
@@ -292,20 +353,6 @@ void Layout::remove_train(Train &t)
                signal_train_removed.emit(t);
 }
 
-void Layout::add_sensor(Sensor &s)
-{
-       if(sensors.insert(&s).second)
-       {
-               s.signal_state_changed.connect(sigc::bind<0>(sigc::mem_fun(this, &Layout::sensor_state_changed), sigc::ref(s)));
-               s.signal_state_changed.connect(sigc::bind<0>(signal_sensor_state_changed, sigc::ref(s)));
-       }
-}
-
-void Layout::remove_sensor(Sensor &s)
-{
-       sensors.erase(&s);
-}
-
 void Layout::tick()
 {
        if(driver)
@@ -317,13 +364,15 @@ void Layout::tick()
                dt = t-last_tick;
        last_tick = t;
 
-       for(set<Sensor *>::iterator i=sensors.begin(); i!=sensors.end(); ++i)
+       clock.tick(dt);
+
+       for(set<Sensor *>::iterator i=sensors.get().begin(); i!=sensors.get().end(); ++i)
                (*i)->tick(dt);
        const set<Signal *> &signals = objects.get<Signal>();
        for(set<Signal *>::iterator i=signals.begin(); i!=signals.end(); ++i)
                (*i)->tick(dt);
        for(map<unsigned, Train *>::iterator i=trains.begin(); i!=trains.end(); ++i)
-               i->second->tick(t, dt);
+               i->second->tick(dt);
 }
 
 void Layout::emergency(const string &msg)
@@ -360,6 +409,15 @@ void Layout::save(const string &fn) const
                writer.write(st);
        }
 
+       const set<BeamGate *> &gates = objects.get<BeamGate>();
+       for(set<BeamGate *>::const_iterator i=gates.begin(); i!=gates.end(); ++i)
+       {
+               DataFile::Statement st("beamgate");
+               (*i)->save(st.sub);
+               writer.write(st);
+       }
+
+       const set<Route *> &routes = track_chains.get<Route>();
        for(set<Route *>::const_iterator i=routes.begin(); i!=routes.end(); ++i)
        {
                if((*i)->is_temporary())
@@ -370,7 +428,8 @@ void Layout::save(const string &fn) const
                writer.write(st);
        }
 
-       for(ZoneSet::const_iterator i=zones.begin(); i!=zones.end(); ++i)
+       const set<Zone *> &zones = track_chains.get<Zone>();
+       for(set<Zone *>::const_iterator i=zones.begin(); i!=zones.end(); ++i)
        {
                DataFile::Statement st("zone");
                (*i)->save(st.sub);
@@ -403,10 +462,7 @@ void Layout::sensor_state_changed(Sensor &sensor, Sensor::State state)
 {
        if(state==Sensor::ACTIVE)
        {
-               Block *block = 0;
-               if(TrackCircuit *tc = dynamic_cast<TrackCircuit *>(&sensor))
-                       block = &tc->get_block();
-
+               Block *block = sensor.get_block();
                if(block && !block->get_train())
                        emergency(format("Unreserved sensor %d triggered", sensor.get_address()));
        }
@@ -471,29 +527,24 @@ Layout::Loader::Loader(Layout &l):
        new_tracks(false)
 {
        add("base",  &Layout::base);
-       add("route", static_cast<void (Loader::*)()>(&Loader::route));
+       add("beamgate", &Loader::beamgate);
+       add("route", &Loader::route);
        add("signal", &Loader::signal);
-       add("track", static_cast<void (Loader::*)(ArticleNumber)>(&Loader::track));
-       add("train", static_cast<void (Loader::*)(ArticleNumber, unsigned, const std::string &)>(&Loader::train));
+       add("track", &Loader::track);
+       add("train", &Loader::train);
        add("turnout", &Loader::turnout);
        add("zone",  &Loader::zone);
-
-       // Deprecated aliases
-       add("route", static_cast<void (Loader::*)(const string &)>(&Loader::route));
-       add("track", static_cast<void (Loader::*)(unsigned)>(&Loader::track));
-       add("train", static_cast<void (Loader::*)(unsigned, unsigned, const std::string &)>(&Loader::train));
 }
 
-void Layout::Loader::route()
+void Layout::Loader::beamgate()
 {
-       Route *rte = new Route(obj);
-       load_sub(*rte);
+       BeamGate *gate = new BeamGate(obj);
+       load_sub(*gate);
 }
 
-void Layout::Loader::route(const string &n)
+void Layout::Loader::route()
 {
        Route *rte = new Route(obj);
-       rte->set_name(n);
        load_sub(*rte);
 }
 
@@ -503,11 +554,6 @@ void Layout::Loader::signal(ArticleNumber art_nr)
        load_sub(*sig);
 }
 
-void Layout::Loader::track(unsigned art_nr)
-{
-       track(ArticleNumber(art_nr));
-}
-
 void Layout::Loader::track(ArticleNumber art_nr)
 {
        Track *trk = new Track(obj, obj.catalogue.get_track(art_nr));
@@ -519,11 +565,6 @@ void Layout::Loader::track(ArticleNumber art_nr)
                        trk->link_to(**i);
 }
 
-void Layout::Loader::train(unsigned art_nr, unsigned addr, const std::string &proto)
-{
-       train(ArticleNumber(art_nr), addr, proto);
-}
-
 void Layout::Loader::train(ArticleNumber art_nr, unsigned addr, const std::string &proto)
 {
        Train *trn = new Train(obj, obj.catalogue.get_vehicle(art_nr), addr, proto);