X-Git-Url: http://git.tdb.fi/?a=blobdiff_plain;f=source%2Flibr2c2%2Flayout.cpp;h=bc149dff1f904a014a0518052dacb36818a62fe6;hb=065d35f5f86a5b9cda95736f59e63845e0bb6fa6;hp=a2c97b7cbdfaaa887992e8d23392c607355d5a2e;hpb=0b75458245997b9df6da47cc4534341c8426084b;p=r2c2.git diff --git a/source/libr2c2/layout.cpp b/source/libr2c2/layout.cpp index a2c97b7..bc149df 100644 --- a/source/libr2c2/layout.cpp +++ b/source/libr2c2/layout.cpp @@ -1,10 +1,12 @@ #include #include +#include #include #include #include #include #include +#include "beamgate.h" #include "block.h" #include "catalogue.h" #include "driver.h" @@ -12,9 +14,12 @@ #include "route.h" #include "signal.h" #include "signaltype.h" +#include "terrain.h" #include "track.h" +#include "trackcircuit.h" #include "tracktype.h" #include "train.h" +#include "vehicle.h" #include "vehicletype.h" #include "zone.h" @@ -36,8 +41,11 @@ namespace R2C2 { Layout::Layout(Catalogue &c, Driver *d): catalogue(c), driver(d), - next_turnout_id(0x800) -{ } + next_turnout_addr(0x800), + emitting_block_reserved(false) +{ + clock.set_rate(60); +} Layout::~Layout() { @@ -46,14 +54,11 @@ Layout::~Layout() while(!trains.empty()) delete trains.begin()->second; - while(!routes.empty()) - delete *routes.begin(); - while(!zones.empty()) - delete *zones.begin(); - while(!tracks.empty()) - delete *tracks.begin(); - while(!blocks.empty()) - delete *blocks.begin(); + track_chains.del(); + track_chains.del(); + objects.del(); + objects.del(); + track_chains.del(); } Driver &Layout::get_driver() const @@ -63,93 +68,240 @@ Driver &Layout::get_driver() const return *driver; } -void Layout::add_track(Track &t) +void Layout::add(Object &o) { - if(tracks.insert(&t).second) + if(objects.insert(o)) { - create_blocks(); - signal_track_added.emit(t); + try + { + signal_object_added.emit(o); + } + catch(...) + { + objects.erase(o); + throw; + } } } -Track *Layout::pick_track(const Vector &start, const Vector &ray) +void Layout::add(Track &t) { - return pick(tracks, start, ray); + if(objects.insert(t)) + { + try + { + // Blocks must be recreated first + create_blocks(); + signal_object_added.emit(t); + } + catch(...) + { + objects.erase(t); + create_blocks(); + throw; + } + } } -void Layout::remove_track(Track &t) +void Layout::add(TrackChain &g) { - if(tracks.erase(&t)) + if(track_chains.insert(g)) { - create_blocks(t); - signal_track_removed.emit(t); + try + { + signal_track_chain_added.emit(g); + } + catch(...) + { + track_chains.erase(g); + throw; + } } } -unsigned Layout::allocate_turnout_id() +void Layout::add(Block &b) { - set used_ids; - for(set::const_iterator i=tracks.begin(); i!=tracks.end(); ++i) - if((*i)->get_turnout_id()) - used_ids.insert((*i)->get_turnout_id()); + if(track_chains.insert(b)) + { + sigc::connection conn = b.signal_reserved.connect(sigc::bind<0>(sigc::mem_fun(this, &Layout::block_reserved), sigc::ref(b))); + try + { + signal_track_chain_added.emit(b); + } + catch(...) + { + track_chains.erase(b); + conn.disconnect(); + throw; + } + } +} - unsigned result = next_turnout_id; - while(used_ids.count(result)) - ++result; - next_turnout_id = result+1; +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))); + } +} - return result; +void Layout::add(BeamGate &g) +{ + add(static_cast(g)); + add(static_cast(g)); +} + +template<> +const set &Layout::get_all() const +{ + return objects.get(); +} + +template<> +const set &Layout::get_all() const +{ + return objects.get(); +} + +template<> +const set &Layout::get_all() const +{ + return objects.get(); +} + +template<> +const set &Layout::get_all() const +{ + return objects.get(); } -void Layout::add_signal(Signal &s) +template<> +const set &Layout::get_all() const { - if(signals.insert(&s).second) - signal_signal_added.emit(s); + return objects.get(); } -Signal *Layout::pick_signal(const Vector &start, const Vector &ray) +template<> +const set &Layout::get_all() const { - return pick(signals, start, ray); + return track_chains.get(); } -void Layout::remove_signal(Signal &s) +template<> +const set &Layout::get_all() const { - if(signals.erase(&s)) - signal_signal_removed.emit(s); + return track_chains.get(); } -Object *Layout::pick_object(const Vector &start, const Vector &ray) +template<> +const set &Layout::get_all() const { - if(Object *obj = pick_track(start, ray)) - return obj; - else if((obj = pick_signal(start, ray))) - return obj; - return 0; + return track_chains.get(); +} + +template<> +const set &Layout::get_all() const +{ + return track_chains.get(); +} + +template<> +const set &Layout::get_all() const +{ + return sensors.get(); +} + +template<> +const set &Layout::get_all() const +{ + return sensors.get(); +} + +template<> +const set &Layout::get_all() const +{ + return sensors.get(); } template -T *Layout::pick(const set &objs, const Vector &start, const Vector &ray) +T *Layout::pick(const Ray &ray) { - for(typename set::const_iterator i=objs.begin(); i!=objs.end(); ++i) - if((*i)->collide_ray(start, ray)) - return *i; + const set &objs = objects.get(); + T *closest = 0; + float distance = -1; + for(set::const_iterator i=objs.begin(); i!=objs.end(); ++i) + if(T *t = dynamic_cast(*i)) + { + float d = -1; + if(t->collide_ray(ray, &d)) + if(!closest || d(const Ray &); +template Track *Layout::pick(const Ray &); +template Signal *Layout::pick(const Ray &); +template Vehicle *Layout::pick(const Ray &); - return 0; +void Layout::remove(Object &o) +{ + if(objects.erase(o)) + signal_object_removed.emit(o); } -void Layout::add_block(Block &b) +void Layout::remove(Track &t) { - blocks.insert(&b); - b.signal_reserved.connect(sigc::bind<0>(signal_block_reserved, sigc::ref(b))); - if(b.get_sensor_id()) + if(objects.erase(t)) { - b.signal_state_changed.connect(sigc::bind<0>(sigc::mem_fun(this, &Layout::block_state_changed), sigc::ref(b))); - b.signal_state_changed.connect(sigc::bind<0>(signal_block_state_changed, sigc::ref(b))); + // Blocks must be recreated first + create_blocks(t); + signal_object_removed.emit(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(g)); + remove(static_cast(g)); +} + +unsigned Layout::allocate_turnout_address() +{ + set used_addrs; + const set &tracks = objects.get(); + for(set::const_iterator i=tracks.begin(); i!=tracks.end(); ++i) + if((*i)->get_type().is_turnout()) + used_addrs.insert((*i)->get_turnout_address()); + + unsigned result = next_turnout_addr; + while(used_addrs.count(result)) + ++result; + next_turnout_addr = result+1; + + return result; +} + Block &Layout::get_block(unsigned id) const { + const set &blocks = track_chains.get(); for(set::const_iterator i=blocks.begin(); i!=blocks.end(); ++i) if((*i)->get_id()==id) return **i; @@ -159,23 +311,31 @@ Block &Layout::get_block(unsigned id) const void Layout::create_blocks() { - set used_tracks; - for(set::const_iterator i=blocks.begin(); i!=blocks.end(); ++i) + set loose_tracks = objects.get(); + const set *blocks = &track_chains.get(); + for(set::const_iterator i=blocks->begin(); i!=blocks->end(); ++i) { const set &btracks = (*i)->get_tracks(); - used_tracks.insert(btracks.begin(), btracks.end()); + for(set::const_iterator j=btracks.begin(); j!=btracks.end(); ++j) + loose_tracks.erase(*j); } - for(set::const_iterator i=tracks.begin(); i!=tracks.end(); ++i) - if(used_tracks.count(*i)==0) - { - Block *block = new Block(*this, **i); - used_tracks.insert(block->get_tracks().begin(), block->get_tracks().end()); - } + list created_blocks; + while(!loose_tracks.empty()) + { + Block *block = new Block(*this, **loose_tracks.begin()); + created_blocks.push_back(block); + + const set &btracks = block->get_tracks(); + for(set::const_iterator i=btracks.begin(); i!=btracks.end(); ++i) + loose_tracks.erase(*i); + } - for(set::iterator i=blocks.begin(); i!=blocks.end(); ++i) - for(set::iterator j=i; j!=blocks.end(); ++j) - if(j!=i) + // The previously obtained set has been invalidated by creating new blocks + blocks = &track_chains.get(); + for(list::iterator i=created_blocks.begin(); i!=created_blocks.end(); ++i) + for(set::const_iterator j=blocks->begin(); j!=blocks->end(); ++j) + if(*j!=*i) (*i)->check_link(**j); } @@ -198,19 +358,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 &routes = track_chains.get(); for(set::const_iterator i=routes.begin(); i!=routes.end(); ++i) if((*i)->get_name()==name) return **i; @@ -219,26 +369,16 @@ Route &Layout::get_route(const string &name) const void Layout::update_routes() { + const set &routes = track_chains.get(); for(set::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 &zones = track_chains.get(); + for(set::const_iterator i=zones.begin(); i!=zones.end(); ++i) if((*i)->get_group()==group) result.push_back(*i); @@ -249,19 +389,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 &zones = track_chains.get(); + for(set::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); @@ -279,19 +414,7 @@ void Layout::remove_train(Train &t) signal_train_removed.emit(t); } -void Layout::add_vehicle(Vehicle &v) -{ - if(vehicles.insert(&v).second) - signal_vehicle_added.emit(v); -} - -void Layout::remove_vehicle(Vehicle &v) -{ - if(vehicles.erase(&v)) - signal_vehicle_removed.emit(v); -} - -void Layout::tick() +void Layout::tick(float speed) { if(driver) driver->tick(); @@ -302,20 +425,36 @@ void Layout::tick() dt = t-last_tick; last_tick = t; - for(set::iterator i=blocks.begin(); i!=blocks.end(); ++i) + dt *= speed; + unsigned count = dt/(10*Time::msec)+1; + dt /= count; + while(count--) + step(dt); +} + +void Layout::step(const Time::TimeDelta &dt) +{ + if(!driver || !driver->is_halted()) + clock.tick(dt); + + for(set::iterator i=sensors.get().begin(); i!=sensors.get().end(); ++i) (*i)->tick(dt); + const set &signals = objects.get(); for(set::iterator i=signals.begin(); i!=signals.end(); ++i) (*i)->tick(dt); for(map::iterator i=trains.begin(); i!=trains.end(); ++i) - i->second->tick(t, dt); + i->second->tick(dt); } -void Layout::emergency(const string &msg) +void Layout::emergency(Block *block, const string &msg) { if(driver) driver->halt(true); - IO::print("Emergency: %s\n", msg); - signal_emergency.emit(msg); + if(block) + IO::print("Emergency at %s: %s\n", block->get_name(), msg); + else + IO::print("Emergency: %s\n", msg); + signal_emergency.emit(block, msg); } void Layout::save(const string &fn) const @@ -326,22 +465,42 @@ void Layout::save(const string &fn) const if(!base.empty()) writer.write((DataFile::Statement("base"), base)); + const set &tracks = objects.get(); for(set::const_iterator i=tracks.begin(); i!=tracks.end(); ++i) { DataFile::Statement st("track"); - st.append((*i)->get_type().get_article_number()); + st.append(catalogue.get_name(&(*i)->get_type())); (*i)->save(st.sub); writer.write(st); } + const set &signals = objects.get(); for(set::const_iterator i=signals.begin(); i!=signals.end(); ++i) { DataFile::Statement st("signal"); - st.append((*i)->get_type().get_article_number()); + st.append(catalogue.get_name(&(*i)->get_type())); (*i)->save(st.sub); writer.write(st); } + const set &terrains = objects.get(); + for(set::const_iterator i=terrains.begin(); i!=terrains.end(); ++i) + { + DataFile::Statement st("terrain"); + st.append(catalogue.get_name(&(*i)->get_type())); + (*i)->save(st.sub); + writer.write(st); + } + + const set &gates = objects.get(); + for(set::const_iterator i=gates.begin(); i!=gates.end(); ++i) + { + DataFile::Statement st("beamgate"); + (*i)->save(st.sub); + writer.write(st); + } + + const set &routes = track_chains.get(); for(set::const_iterator i=routes.begin(); i!=routes.end(); ++i) { if((*i)->is_temporary()) @@ -352,7 +511,8 @@ void Layout::save(const string &fn) const writer.write(st); } - for(ZoneSet::const_iterator i=zones.begin(); i!=zones.end(); ++i) + const set &zones = track_chains.get(); + for(set::const_iterator i=zones.begin(); i!=zones.end(); ++i) { DataFile::Statement st("zone"); (*i)->save(st.sub); @@ -365,14 +525,26 @@ void Layout::save_dynamic(const string &fn) const IO::BufferedFile out(fn, IO::M_WRITE); DataFile::Writer writer(out); + { + DataFile::Statement st("clock"); + clock.save(st.sub); + writer.write(st); + } + + const set &tracks = objects.get(); for(set::const_iterator i=tracks.begin(); i!=tracks.end(); ++i) - if(unsigned tid = (*i)->get_turnout_id()) - writer.write((DataFile::Statement("turnout"), tid, (*i)->get_active_path())); + if((*i)->get_type().is_turnout()) + { + DataFile::Statement st("turnout"); + st.append((*i)->get_turnout_address()); + (*i)->save_dynamic(st.sub); + writer.write(st); + } for(map::const_iterator i=trains.begin(); i!=trains.end(); ++i) { DataFile::Statement st("train"); - st.append(i->second->get_locomotive_type().get_article_number()); + st.append(catalogue.get_name(&i->second->get_locomotive_type())); st.append(i->second->get_address()); st.append(i->second->get_protocol()); i->second->save(st.sub); @@ -380,84 +552,186 @@ void Layout::save_dynamic(const string &fn) const } } -void Layout::block_state_changed(Block &block, Block::State state) +void Layout::sensor_state_changed(Sensor &sensor, Sensor::State state) +{ + if(state==Sensor::ACTIVE) + { + Block *block = sensor.get_block(); + if(block && !block->get_train()) + emergency(block, "Unreserved sensor triggered"); + } +} + +void Layout::block_reserved(Block &block, Train *train) +{ + if(emitting_block_reserved) + { + if(!train) + { + for(deque::iterator i=block_reserve_queue.end(); i!=block_reserve_queue.begin(); ) + if((--i)->block==&block) + { + block_reserve_queue.erase(i); + return; + } + } + + block_reserve_queue.push_back(BlockReservation(block, train)); + } + else + { + SetFlag setf(emitting_block_reserved); + signal_block_reserved.emit(block, train); + while(!block_reserve_queue.empty()) + { + BlockReservation br = block_reserve_queue.front(); + block_reserve_queue.pop_front(); + signal_block_reserved.emit(*br.block, br.train); + } + } +} + + +template +Layout::Storage::~Storage() { - if(state==Block::ACTIVE && !block.get_train()) - emergency(format("Unreserved sensor %d triggered", block.get_sensor_id())); + while(!base.empty()) + delete *base.begin(); } +template +bool Layout::Storage::insert(B &b) +{ + bool result = base.insert(&b).second; + if(result) + caches.clear(); + return result; +} + +template +bool Layout::Storage::erase(B &b) +{ + bool result = base.erase(&b); + if(result) + caches.clear(); + return result; +} + +template +template +const set &Layout::Storage::get() const +{ + for(list::const_iterator i=caches.begin(); i!=caches.end(); ++i) + if(i->check_type >()) + return i->value >(); + + caches.push_back(set()); + set &result = caches.back().value >(); + for(typename set::const_iterator i=base.begin(); i!=base.end(); ++i) + if(T *t = dynamic_cast(*i)) + result.insert(t); + + return result; +} + +template +template +void Layout::Storage::del() +{ + set ts = get(); + for(typename set::iterator i=ts.begin(); i!=ts.end(); ++i) + if(base.count(*i)) + delete *i; +} + + +Layout::BlockReservation::BlockReservation(Block &b, Train *t): + block(&b), + train(t) +{ } + Layout::Loader::Loader(Layout &l): - DataFile::ObjectLoader(l), - new_tracks(false) + DataFile::ObjectLoader(l) { add("base", &Layout::base); - add("route", static_cast(&Loader::route)); + add("beamgate", &Loader::beamgate); + add("clock", &Loader::clock); + add("route", &Loader::route); add("signal", &Loader::signal); - add("track", static_cast(&Loader::track)); - add("train", static_cast(&Loader::train)); + add("terrain", &Loader::terrain); + add("track", &Loader::track); + add("train", &Loader::train); add("turnout", &Loader::turnout); add("zone", &Loader::zone); - // Deprecated aliases - add("route", static_cast(&Loader::route)); - add("track", static_cast(&Loader::track)); - add("train", static_cast(&Loader::train)); + // Deprecated + add("turnout", &Loader::turnout2); } -void Layout::Loader::finish() +void Layout::Loader::beamgate() { - for(set::iterator i=obj.tracks.begin(); i!=obj.tracks.end(); ++i) - (*i)->check_slope(); + BeamGate *gate = new BeamGate(obj); + load_sub(*gate); } -void Layout::Loader::route() +void Layout::Loader::clock() { - Route *rte = new Route(obj); - load_sub(*rte); + load_sub(obj.clock); } -void Layout::Loader::route(const string &n) +void Layout::Loader::route() { Route *rte = new Route(obj); - rte->set_name(n); load_sub(*rte); } -void Layout::Loader::signal(ArticleNumber art_nr) +void Layout::Loader::signal(const string &n) { - Signal *sig = new Signal(obj, obj.catalogue.get_signal(art_nr)); + Signal *sig = new Signal(obj, obj.catalogue.get(n)); load_sub(*sig); } -void Layout::Loader::track(unsigned art_nr) +void Layout::Loader::terrain(const string &n) { - track(ArticleNumber(art_nr)); + Terrain *ter = new Terrain(obj, obj.catalogue.get(n)); + load_sub(*ter); } -void Layout::Loader::track(ArticleNumber art_nr) +void Layout::Loader::track(const string &n) { - Track *trk = new Track(obj, obj.catalogue.get_track(art_nr)); + Track *trk = new Track(obj, obj.catalogue.get(n)); load_sub(*trk); - new_tracks = true; - for(set::iterator i=obj.tracks.begin(); i!=obj.tracks.end(); ++i) + const set &tracks = obj.objects.get(); + for(set::const_iterator i=tracks.begin(); i!=tracks.end(); ++i) if(*i!=trk) trk->link_to(**i); } -void Layout::Loader::train(unsigned art_nr, unsigned addr, const std::string &proto) +void Layout::Loader::train(const string &n, unsigned addr, const std::string &proto) { - train(ArticleNumber(art_nr), addr, proto); + Train *trn = new Train(obj, obj.catalogue.get(n), addr, proto); + load_sub(*trn); } -void Layout::Loader::train(ArticleNumber art_nr, unsigned addr, const std::string &proto) +void Layout::Loader::turnout(unsigned addr) { - Train *trn = new Train(obj, obj.catalogue.get_vehicle(art_nr), addr, proto); - load_sub(*trn); + /* Kinda slow, but maintaining a map of turnouts seems more trouble than + it's worth at this point. */ + const set &tracks = obj.objects.get(); + for(set::const_iterator i=tracks.begin(); i!=tracks.end(); ++i) + if((*i)->get_turnout_address()==addr) + { + load_sub(**i); + return; + } + + throw key_error(addr); } -void Layout::Loader::turnout(unsigned addr, unsigned path) +void Layout::Loader::turnout2(unsigned addr, unsigned path) { + // XXX Discrepancy between ids and addresses if(obj.driver) obj.driver->set_turnout(addr, path); }