6 #include <msp/fs/stat.h>
7 #include <msp/fs/utils.h>
8 #include <msp/graphics/display.h>
9 #include <msp/graphics/window.h>
10 #include <msp/gl/blend.h>
11 #include <msp/gl/framebuffer.h>
12 #include <msp/gl/matrix.h>
13 #include <msp/gl/misc.h>
14 #include <msp/gl/tests.h>
15 #include <msp/io/print.h>
16 #include <msp/strings/format.h>
17 #include <msp/time/units.h>
18 #include <msp/time/utils.h>
19 #include "libr2c2/driver.h"
20 #include "libr2c2/trackcircuit.h"
21 #include "libr2c2/tracktype.h"
24 #include "3d/vehicle.h"
26 #include "mainpanel.h"
27 #include "trainpanel.h"
28 #include "trainproperties.h"
29 #include "trainview.h"
35 Engineer::Engineer(int argc, char **argv):
37 window(options.screen_w, options.screen_h, options.fullscreen),
41 layout(catalogue, (options.driver.empty() ? 0 : Driver::create(options.driver))),
44 pipeline(window.get_width(), window.get_height(), false),
52 window.set_title("Railroad Engineer");
53 window.signal_close.connect(sigc::bind(sigc::mem_fun(this, &Engineer::exit), 0));
55 root = new GLtk::Root(ui_res, window);
56 mouse.signal_button_press.connect(sigc::bind_return(sigc::mem_fun(this, &Engineer::button_press), false));
57 mouse.signal_axis_motion.connect(sigc::bind_return(sigc::mem_fun(this, &Engineer::axis_motion), false));
58 root->set_visible(true);
60 main_panel = new MainPanel(*this);
61 root->add(*main_panel);
62 main_panel->set_position(0, window.get_height()-main_panel->get_geometry().h);
63 main_panel->set_visible(true);
65 overlay = new Overlay3D(ui_res.get_default_font());
67 // Setup railroad control
68 DataFile::load(catalogue, "tracks.dat");
69 DataFile::load(catalogue, "locos.dat");
70 DataFile::load(catalogue, "wagons.dat");
71 DataFile::load(layout, options.layout_fn);
73 layout.signal_train_added.connect(sigc::mem_fun(this, &Engineer::train_added));
74 layout.signal_block_reserved.connect(sigc::hide<1>(sigc::mem_fun(this, &Engineer::reset_block_color)));
75 layout.signal_emergency.connect(sigc::mem_fun(this, &Engineer::set_status));
76 const set<Block *> &blocks = layout.get_all<Block>();
77 for(set<Block *>::const_iterator i=blocks.begin(); i!=blocks.end(); ++i)
78 (*i)->get_sensor().signal_state_changed.connect(sigc::hide(sigc::bind(sigc::mem_fun(this, &Engineer::reset_block_color), sigc::ref(**i))));
80 if(FS::exists(options.state_fn))
81 DataFile::load(layout, options.state_fn);
85 server = new Server(layout);
86 server->use_event_dispatcher(event_disp);
90 DataFile::load(arrow_mesh, "arrow.mesh");
92 pipeline.set_camera(&camera);
93 pipeline.add_renderable_for_pass(layout_3d.get_scene(), 0);
94 pipeline.add_renderable_for_pass(layout_3d.get_path_scene(), "unlit");
95 pipeline.add_renderable_for_pass(*overlay, "overlay");
97 light.set_position(GL::Vector4(0, -0.259, 0.966, 0));
98 light.set_diffuse(GL::Color(0.9));
99 lighting.set_ambient(GL::Color(0.4));
100 lighting.attach(0, light);
102 GL::Pipeline::Pass *pass = &pipeline.add_pass(0);
103 pass->set_depth_test(&GL::DepthTest::lequal());
104 pass->set_lighting(&lighting);
106 pass = &pipeline.add_pass("unlit");
107 pass->set_depth_test(&GL::DepthTest::lequal());
109 pass = &pipeline.add_pass("overlay");
110 pass->set_blend(&GL::Blend::alpha());
114 // Catch various signals so we can stop the trains in case we get terminated
115 catch_signal(SIGINT);
116 catch_signal(SIGTERM);
117 catch_signal(SIGSEGV);
118 catch_signal(SIGILL);
119 catch_signal(SIGFPE);
120 catch_signal(SIGABRT);
123 Engineer::~Engineer()
125 const map<unsigned, Train *> &trains = layout.get_trains();
126 for(map<unsigned, Train *>::const_iterator i=trains.begin(); i!=trains.end(); ++i)
127 layout.get_driver().set_loco_speed(i->first, 0);
128 layout.get_driver().flush();
130 if(!options.simulate)
132 layout.save_dynamic(options.state_fn+".tmp");
133 FS::rename(options.state_fn+".tmp", options.state_fn);
142 void Engineer::set_status(const string &text)
144 main_panel->set_status_text(text);
145 status_timeout = Time::now()+10*Time::sec;
148 void Engineer::rearrange_panels()
150 int y = main_panel->get_geometry().y;
151 for(list<TrainPanel *>::iterator i=train_panels.begin(); i!=train_panels.end(); ++i)
153 y -= (*i)->get_geometry().h;
154 (*i)->set_position(0, y);
158 void Engineer::add_train_view(TrainView &tv)
160 train_views.push_back(&tv);
163 void Engineer::remove_train_view(TrainView &tv)
165 train_views.erase(remove(train_views.begin(), train_views.end(), &tv), train_views.end());
168 void Engineer::pick(bool with_ep)
172 picking_entry = (with_ep ? 0 : -1);
179 return Application::main();
182 void Engineer::tick()
184 window.get_display().tick();
186 for(list<Train *>::iterator i=new_trains.begin(); i!=new_trains.end(); ++i)
187 process_new_train(**i);
191 event_disp.tick(Time::zero);
193 for(list<TrainView *>::iterator i=train_views.begin(); i!=train_views.end(); ++i)
196 if(status_timeout && Time::now()>status_timeout)
198 main_panel->set_status_text(string());
199 status_timeout = Time::TimeStamp();
202 GL::Framebuffer::system().clear(GL::COLOR_BUFFER_BIT|GL::DEPTH_BUFFER_BIT);
208 pointer_moved = false;
212 Track *track = pick_track(pointer);
213 if(track && track!=picking_track)
215 picking_track = track;
220 picking_path = new Path3D(layout_3d.get_track(*track));
222 picking_path->set_mask(picking_track->get_type().get_endpoint(picking_entry).paths);
224 picking_path->set_mask(picking_track->get_type().get_paths());
225 picking_path->set_color(GL::Color(0));
226 picking_path->set_layer(1);
231 if(picking && picking_track && picking_entry>=0)
234 GL::MatrixStack::Push push_mat(GL::MatrixStack::modelview());
236 Snap sn = picking_track->get_snap_node(picking_entry);
238 GL::MatrixStack::modelview() *= GL::Matrix::translation(sn.position+GL::Vector3(0, 0, 0.03));
239 GL::MatrixStack::modelview() *= GL::Matrix::rotation(sn.rotation+Angle::half_turn(), 0, 0, 1);
246 window.swap_buffers();
249 void Engineer::button_press(unsigned btn)
253 if(btn==1 && picking_track)
258 signal_pick_done.emit(picking_track, picking_entry);
260 else if(btn==3 && picking_entry>=0)
262 picking_entry = (picking_entry+1)%picking_track->get_type().get_endpoints().size();
263 picking_path->set_mask(picking_track->get_type().get_endpoint(picking_entry).paths);
268 Track *track = pick_track(pointer);
271 if(track->get_turnout_id())
273 Block &block = track->get_block();
274 if(block.get_train() && block.get_train()->is_block_critical(block))
275 set_status("Turnout is busy");
278 unsigned paths = track->get_type().get_paths();
279 unsigned i = track->get_active_path()+1;
280 while(!(paths&(1<<i)))
287 track->set_active_path(i);
288 set_status(format("Turnout %d", track->get_turnout_id()));
291 if(unsigned sid = track->get_sensor_id())
294 layout.get_driver().set_sensor(sid, !layout.get_driver().get_sensor(sid));
295 set_status(format("Sensor %d", sid));
301 void Engineer::axis_motion(unsigned axis, float value, float)
307 pointer_moved = true;
310 void Engineer::view_all()
312 const Layout3D::TrackMap &tracks = layout_3d.get_tracks();
314 float view_aspect = float(window.get_width()-200)/window.get_height();
315 float view_height = tan(camera.get_field_of_view()/2.0f)*2.0f;
316 float best_score = 0;
319 for(Angle angle; angle<Angle::half_turn(); angle+=Angle::from_radians(0.01))
321 Transform trans = Transform::rotation(-angle, Vector(0, 0, 1));
323 for(Layout3D::TrackMap::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
324 bbox = bbox|trans.transform(i->second->get_track().get_bounding_box());
326 const Vector &minp = bbox.get_minimum_point();
327 const Vector &maxp = bbox.get_maximum_point();
329 float width = maxp.x-minp.x;
330 float height = maxp.y-minp.y;
331 float aspect = width/height;
332 float score = min(aspect/view_aspect, view_aspect/aspect);
338 float size = max(width/view_aspect, height);
339 float c = cos(angle);
340 float s = sin(angle);
341 float x = (minp.x+maxp.x)/2-size*105/window.get_height();
342 float y = (minp.y+maxp.y)/2;
343 float z = max(size*1.05/view_height, 0.15);
345 pos = GL::Vector3(c*x-s*y, s*x+c*y, z);
346 up = GL::Vector3(-s, c, 0);
350 camera.set_position(pos);
351 camera.set_up_direction(up);
352 camera.set_look_direction(GL::Vector3(0, 0, -1));
353 camera.set_aspect(float(window.get_width())/window.get_height());
354 camera.set_depth_clip(pos.z*0.5, pos.z*1.5);
357 void Engineer::set_block_color(const Block &block, const GL::Color &color)
359 const set<Track *> &tracks = block.get_tracks();
360 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
361 layout_3d.get_track(**i).get_path().set_color(color);
364 void Engineer::reset_block_color(const Block &block)
366 bool active = block.get_sensor().get_state()>Sensor::INACTIVE;
368 if(block.get_train())
371 map<Train *, GL::Color>::iterator i = train_colors.find(block.get_train());
372 if(i!=train_colors.end())
376 set_block_color(block, color*0.6);
378 set_block_color(block, color*0.5+0.5);
381 set_block_color(block, GL::Color(0.6));
383 set_block_color(block, GL::Color(1));
386 Track *Engineer::pick_track(const Vector &p)
388 const GL::Vector3 &start = camera.get_position();
389 GL::Vector4 ray = camera.unproject(GL::Vector4(p.x, p.y, 0, 0));
391 return layout.pick<Track>(Ray(start, Vector(ray)));
394 void Engineer::process_new_train(Train &train)
396 TrainPanel *tpanel = new TrainPanel(*this, train);
398 train_panels.push_back(tpanel);
401 Vehicle3D &loco3d = layout_3d.get_vehicle(train.get_vehicle(0));
402 overlay->set_label(loco3d, train.get_name());
403 train.signal_name_changed.connect(sigc::bind<0>(sigc::mem_fun(overlay, &Overlay3D::set_label), sigc::ref(loco3d)));
406 void Engineer::train_added(Train &train)
408 new_trains.push_back(&train);
410 GL::Color best_color;
412 for(unsigned i=0; i<10; ++i)
415 unsigned h = rand()%3;
416 color.r = (h==0 ? 0.0 : rand()*1.0/RAND_MAX);
417 color.g = (h==1 ? 0.0 : rand()*1.0/RAND_MAX);
418 color.b = (h==2 ? 0.0 : rand()*1.0/RAND_MAX);
419 color = color*(1/max(max(color.r, color.g), color.b));
421 for(map<Train *, GL::Color>::const_iterator j=train_colors.begin(); j!=train_colors.end(); ++j)
423 float dr = color.r-j->second.r;
424 float dg = color.g-j->second.g;
425 float db = color.b-j->second.b;
426 float d_sq = dr*dr+dg*dg+db*db;
430 if(min_d_sq>best_d_sq)
433 best_d_sq = min_d_sq;
436 train_colors[&train] = best_color;
439 void Engineer::sighandler(int sig)
441 if(sig==SIGSEGV || sig==SIGILL || sig==SIGFPE || sig==SIGABRT)
443 signal(sig, SIG_DFL);
444 IO::print(IO::cerr, "Fatal signal received, terminating\n");
445 const map<unsigned, Train *> &trains = layout.get_trains();
446 for(map<unsigned, Train *>::const_iterator i=trains.begin(); i!=trains.end(); ++i)
447 layout.get_driver().set_loco_speed(i->first, 0);
448 layout.get_driver().flush();
451 else if(sig==SIGTERM || sig==SIGINT)