X-Git-Url: http://git.tdb.fi/?a=blobdiff_plain;f=source%2Flibr2c2%2Flayout.cpp;h=72f083d57cc2da491dead13077ad495b716f5942;hb=399b48a7a80dafde49e7530ff8dfd2820232a73f;hp=0025ec3b5b3adcd305ebd08ec8b8a9c44b8622ac;hpb=2220ba2f11705ea9a4e480603d43ab7ed4cf5a89;p=r2c2.git diff --git a/source/libr2c2/layout.cpp b/source/libr2c2/layout.cpp index 0025ec3..72f083d 100644 --- a/source/libr2c2/layout.cpp +++ b/source/libr2c2/layout.cpp @@ -1,5 +1,6 @@ #include #include +#include #include #include #include @@ -40,7 +41,8 @@ namespace R2C2 { Layout::Layout(Catalogue &c, Driver *d): catalogue(c), driver(d), - next_turnout_addr(0x800) + next_turnout_addr(0x800), + emitting_block_reserved(false) { clock.set_rate(60); } @@ -69,31 +71,69 @@ Driver &Layout::get_driver() const void Layout::add(Object &o) { if(objects.insert(o)) - signal_object_added.emit(o); + { + try + { + signal_object_added.emit(o); + } + catch(...) + { + objects.erase(o); + throw; + } + } } void Layout::add(Track &t) { if(objects.insert(t)) { - // Blocks must be recreated first - create_blocks(); - signal_object_added.emit(t); + try + { + // Blocks must be recreated first + create_blocks(); + signal_object_added.emit(t); + } + catch(...) + { + objects.erase(t); + create_blocks(); + throw; + } } } void Layout::add(TrackChain &g) { if(track_chains.insert(g)) - signal_track_chain_added.emit(g); + { + try + { + signal_track_chain_added.emit(g); + } + catch(...) + { + track_chains.erase(g); + throw; + } + } } 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); + 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; + } } } @@ -188,12 +228,21 @@ template T *Layout::pick(const Ray &ray) { 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)) - if(t->collide_ray(ray)) - return t; + { + float d = -1; + if(t->collide_ray(ray, &d)) + if(!closest || d(const Ray &); @@ -239,7 +288,7 @@ 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_turnout_address()) + if((*i)->get_type().is_turnout()) used_addrs.insert((*i)->get_turnout_address()); unsigned result = next_turnout_addr; @@ -376,7 +425,8 @@ void Layout::tick() dt = t-last_tick; last_tick = t; - clock.tick(dt); + if(!driver || !driver->is_halted()) + clock.tick(dt); for(set::iterator i=sensors.get().begin(); i!=sensors.get().end(); ++i) (*i)->tick(dt); @@ -387,12 +437,15 @@ void Layout::tick() 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 @@ -407,7 +460,7 @@ void Layout::save(const string &fn) const 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); } @@ -416,7 +469,7 @@ void Layout::save(const string &fn) const 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); } @@ -425,7 +478,7 @@ void Layout::save(const string &fn) const for(set::const_iterator i=terrains.begin(); i!=terrains.end(); ++i) { DataFile::Statement st("terrain"); - st.append((*i)->get_type().get_article_number()); + st.append(catalogue.get_name(&(*i)->get_type())); (*i)->save(st.sub); writer.write(st); } @@ -463,15 +516,21 @@ 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 taddr = (*i)->get_turnout_address()) - writer.write((DataFile::Statement("turnout"), taddr, (*i)->get_active_path())); + if((*i)->get_type().is_turnout()) + writer.write((DataFile::Statement("turnout"), (*i)->get_turnout_address(), (*i)->get_active_path())); 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); @@ -485,7 +544,24 @@ void Layout::sensor_state_changed(Sensor &sensor, Sensor::State state) { Block *block = sensor.get_block(); if(block && !block->get_train()) - emergency(format("Unreserved sensor %d triggered", sensor.get_address())); + emergency(block, "Unreserved sensor triggered"); + } +} + +void Layout::block_reserved(Block &block, Train *train) +{ + if(emitting_block_reserved) + 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); + } } } @@ -543,11 +619,18 @@ void Layout::Storage::del() } +Layout::BlockReservation::BlockReservation(Block &b, Train *t): + block(b), + train(t) +{ } + + Layout::Loader::Loader(Layout &l): DataFile::ObjectLoader(l) { add("base", &Layout::base); add("beamgate", &Loader::beamgate); + add("clock", &Loader::clock); add("route", &Loader::route); add("signal", &Loader::signal); add("terrain", &Loader::terrain); @@ -563,27 +646,32 @@ void Layout::Loader::beamgate() load_sub(*gate); } +void Layout::Loader::clock() +{ + load_sub(obj.clock); +} + void Layout::Loader::route() { Route *rte = new Route(obj); 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(art_nr)); + Signal *sig = new Signal(obj, obj.catalogue.get(n)); load_sub(*sig); } -void Layout::Loader::terrain(ArticleNumber art_nr) +void Layout::Loader::terrain(const string &n) { - Terrain *ter = new Terrain(obj, obj.catalogue.get(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(art_nr)); + Track *trk = new Track(obj, obj.catalogue.get(n)); load_sub(*trk); const set &tracks = obj.objects.get(); for(set::const_iterator i=tracks.begin(); i!=tracks.end(); ++i) @@ -591,9 +679,9 @@ void Layout::Loader::track(ArticleNumber art_nr) trk->link_to(**i); } -void Layout::Loader::train(ArticleNumber art_nr, unsigned addr, const std::string &proto) +void Layout::Loader::train(const string &n, unsigned addr, const std::string &proto) { - Train *trn = new Train(obj, obj.catalogue.get(art_nr), addr, proto); + Train *trn = new Train(obj, obj.catalogue.get(n), addr, proto); load_sub(*trn); }