3 This file is part of the MSP Märklin suite
4 Copyright © 2006-2010 Mikkosoft Productions, Mikko Rasa
5 Distributed under the GPL
12 #include <msp/core/except.h>
13 #include <msp/fs/stat.h>
14 #include <msp/gbase/display.h>
15 #include <msp/gbase/window.h>
16 #include <msp/gl/blend.h>
17 #include <msp/gl/framebuffer.h>
18 #include <msp/gl/matrix.h>
19 #include <msp/gl/misc.h>
20 #include <msp/gl/projection.h>
21 #include <msp/gl/tests.h>
22 #include <msp/gl/transform.h>
23 #include <msp/io/print.h>
24 #include <msp/strings/formatter.h>
25 #include <msp/time/units.h>
26 #include <msp/time/utils.h>
27 #include "libmarklin/driver.h"
28 #include "libmarklin/tracktype.h"
31 #include "3d/vehicle.h"
33 #include "mainpanel.h"
34 #include "trainpanel.h"
35 #include "trainproperties.h"
38 using namespace Marklin;
41 Application::RegApp<Engineer> Engineer::reg;
43 Engineer::Engineer(int argc, char **argv):
45 window(options.screen_w, options.screen_h, options.fullscreen),
46 layout(catalogue, (options.driver.empty() ? 0 : Driver::create(options.driver))),
49 pipeline(window.get_width(), window.get_height(), false),
56 window.set_title("Railroad Engineer");
57 window.signal_close.connect(sigc::bind(sigc::mem_fun(this, &Engineer::exit), 0));
59 DataFile::load(ui_res, "marklin.res");
60 root = new GLtk::Root(ui_res, window);
61 root->signal_button_press.connect(sigc::mem_fun(this, &Engineer::button_press));
62 root->signal_pointer_motion.connect(sigc::mem_fun(this, &Engineer::pointer_motion));
63 root->set_visible(true);
65 main_panel = new MainPanel(*this, ui_res);
66 root->add(*main_panel);
67 main_panel->set_position(0, window.get_height()-main_panel->get_geometry().h);
68 main_panel->set_visible(true);
70 overlay = new Overlay3D(window, camera, ui_res.get_default_font());
72 // Setup railroad control
73 DataFile::load(catalogue, "tracks.dat");
74 DataFile::load(catalogue, "locos.dat");
75 DataFile::load(catalogue, "wagons.dat");
76 DataFile::load(layout, options.layout_fn);
78 layout.signal_train_added.connect(sigc::mem_fun(this, &Engineer::train_added));
79 layout.signal_block_reserved.connect(sigc::mem_fun(this, &Engineer::block_reserved));
80 layout.signal_emergency.connect(sigc::mem_fun(this, &Engineer::set_status));
81 layout.get_driver().signal_sensor.connect(sigc::mem_fun(this, &Engineer::sensor_event));
82 if(FS::exists("engineer.state"))
83 DataFile::load(layout, "engineer.state");
87 server = new Server(layout);
88 server->use_event_dispatcher(event_disp);
92 DataFile::load(arrow_mesh, "arrow.mesh");
94 pipeline.set_camera(&camera);
95 pipeline.add_renderable(layout_3d.get_scene());
97 light.set_position(0, -0.259, 0.966, 0);
98 lighting.attach(0, light);
100 GL::PipelinePass &pass = pipeline.add_pass(0);
101 pass.depth_test = &GL::DepthTest::lequal();
102 pass.lighting = &lighting;
106 // Catch various signals so we can stop the trains in case we get terminated
107 catch_signal(SIGINT);
108 catch_signal(SIGTERM);
109 catch_signal(SIGSEGV);
110 catch_signal(SIGILL);
111 catch_signal(SIGFPE);
112 catch_signal(SIGABRT);
115 Engineer::~Engineer()
117 const map<unsigned, Train *> &trains = layout.get_trains();
118 for(map<unsigned, Train *>::const_iterator i=trains.begin(); i!=trains.end(); ++i)
119 layout.get_driver().set_loco_speed(i->first, 0);
120 layout.get_driver().flush();
122 if(!options.simulate)
123 layout.save_trains("engineer.state");
131 void Engineer::set_status(const string &text)
133 main_panel->set_status_text(text);
134 status_timeout = Time::now()+10*Time::sec;
137 void Engineer::pick(bool with_ep)
141 picking_entry = (with_ep ? 0 : -1);
148 return Application::main();
151 void Engineer::tick()
153 window.get_display().tick();
156 event_disp.tick(Time::zero);
158 if(status_timeout && Time::now()>status_timeout)
160 main_panel->set_status_text(string());
161 status_timeout = Time::TimeStamp();
164 GL::clear(GL::COLOR_BUFFER_BIT|GL::DEPTH_BUFFER_BIT);
166 pipeline.render_all();
168 GL::Bind depth(GL::DepthTest::lequal());
169 layout_3d.get_path_scene().render();
172 GL::Bind blend(GL::Blend::alpha());
176 if(picking && picking_track && picking_entry>=0)
178 GL::PushMatrix push_mat;
180 float rot = picking_track->get_endpoint_direction(picking_entry);
181 Point pos = picking_track->get_endpoint_position(picking_entry);
183 GL::translate(pos.x, pos.y, pos.z+0.03);
184 GL::rotate(rot*180/M_PI+180, 0, 0, 1);
189 const GLtk::Geometry &rgeom = root->get_geometry();
190 GL::matrix_mode(GL::PROJECTION);
192 GL::ortho_bottomleft(rgeom.w, rgeom.h);
193 GL::matrix_mode(GL::MODELVIEW);
197 GL::Bind blend(GL::Blend::alpha());
199 GL::Texture::unbind();
202 window.swap_buffers();
205 void Engineer::button_press(int x, int y, unsigned btn, unsigned)
209 if(btn==1 && picking_track)
214 signal_pick_done.emit(picking_track, picking_entry);
216 else if(btn==3 && picking_entry>=0)
218 picking_entry = (picking_entry+1)%picking_track->get_type().get_endpoints().size();
219 picking_path->set_mask(picking_track->get_type().get_endpoints()[picking_entry].paths);
224 Track3D *t3d = pick_track(x, window.get_height()-y-1);
227 Track &track = t3d->get_track();
228 if(track.get_turnout_id())
230 Block &block = layout.get_block_by_track(track);
231 if(block.get_train() && !block.get_train()->free_block(block))
232 set_status("Turnout is busy");
235 unsigned paths = track.get_type().get_paths();
236 unsigned i = track.get_active_path()+1;
237 while(!(paths&(1<<i)))
244 track.set_active_path(i);
247 else if(options.simulate)
249 if(unsigned sid=track.get_sensor_id())
250 layout.get_driver().set_sensor(sid, !layout.get_driver().get_sensor(sid));
256 void Engineer::pointer_motion(int x, int y)
260 Track3D *track = pick_track(x, window.get_height()-y-1);
261 if(track && &track->get_track()!=picking_track)
263 picking_track = &track->get_track();
268 picking_path = new Path3D(*track);
270 picking_path->set_mask(picking_track->get_type().get_endpoints()[picking_entry].paths);
272 picking_path->set_mask(picking_track->get_type().get_paths());
273 picking_path->set_color(GL::Color(0));
274 picking_path->set_layer(1);
279 void Engineer::view_all()
281 const list<Track3D *> &tracks = layout_3d.get_tracks();
283 float view_aspect = float(window.get_width()-200)/window.get_height();
284 float view_height = tan(camera.get_field_of_view()/2)*2;
285 float best_score = 0;
288 for(float angle=0; angle<M_PI; angle+=0.01)
294 for(list<Track3D *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
297 (*i)->get_bounds(angle, minp, maxp);
298 min_x = min(min_x, minp.x);
299 max_x = max(max_x, maxp.x);
300 min_y = min(min_y, minp.y);
301 max_y = max(max_y, maxp.y);
304 float width = max_x-min_x;
305 float height = max_y-min_y;
306 float aspect = width/height;
307 float score = min(aspect/view_aspect, view_aspect/aspect);
313 float size = max(width/view_aspect, height);
314 float c = cos(angle);
315 float s = sin(angle);
316 float x = (min_x+max_x)/2-size*105/window.get_height();
317 float y = (min_y+max_y)/2;
318 float z = max(size*1.05/view_height, 0.15);
320 pos = GL::Vector3(c*x-s*y, s*x+c*y, z);
321 up = GL::Vector3(-s, c, 0);
325 camera.set_position(pos);
326 camera.set_up_direction(up);
327 camera.set_look_direction(GL::Vector3(0, 0, -1));
328 camera.set_aspect(float(window.get_width())/window.get_height());
329 camera.set_depth_clip(pos.z*0.5, pos.z*1.5);
332 void Engineer::set_block_color(const Block &block, const GL::Color &color)
334 const set<Track *> &tracks = block.get_tracks();
335 for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
336 layout_3d.get_track(**i).get_path().set_color(color);
339 void Engineer::reset_block_color(const Block &block)
342 if(unsigned sid=block.get_sensor_id())
343 active = layout.get_driver().get_sensor(sid);
345 if(block.get_train())
348 map<Train *, GL::Color>::iterator i = train_colors.find(block.get_train());
349 if(i!=train_colors.end())
353 set_block_color(block, color*0.6);
355 set_block_color(block, color*0.5+0.5);
358 set_block_color(block, GL::Color(0.6));
360 set_block_color(block, GL::Color(1));
363 void Engineer::sensor_event(unsigned addr, bool)
365 const set<Block *> &blocks = layout.get_blocks();
366 for(set<Block *>::const_iterator i=blocks.begin(); i!=blocks.end(); ++i)
367 if((*i)->get_sensor_id()==addr)
368 reset_block_color(**i);
371 void Engineer::block_reserved(const Block &block, const Train *)
373 reset_block_color(block);
376 Track3D *Engineer::pick_track(int x, int y)
378 float view_height = tan(camera.get_field_of_view()/2)*2;
379 float xx = ((float(x)-window.get_width()/2)/window.get_height())*view_height;
380 float yy = (float(y)/window.get_height()-0.5)*view_height;
381 float size = 4.0/window.get_height()*view_height;
385 return layout_3d.pick_track(xx, yy, size);
388 void Engineer::train_added(Train &train)
390 TrainPanel *tpanel = new TrainPanel(*this, ui_res, train);
392 int y = main_panel->get_geometry().y;
393 for(list<TrainPanel *>::iterator i=train_panels.begin(); i!=train_panels.end(); ++i)
394 y -= (*i)->get_geometry().h;
395 tpanel->set_position(0, y-tpanel->get_geometry().h);
396 train_panels.push_back(tpanel);
397 tpanel->set_visible(true);
399 Vehicle3D &loco3d = layout_3d.get_vehicle(train.get_vehicle(0));
400 overlay->set_label(loco3d, train.get_name());
401 train.signal_name_changed.connect(sigc::bind<0>(sigc::mem_fun(overlay, &Overlay3D::set_label), sigc::ref(loco3d)));
403 GL::Color best_color;
405 for(unsigned i=0; i<10; ++i)
408 color.r = rand()*1.0/RAND_MAX;
409 color.g = rand()*1.0/RAND_MAX;
410 color.b = rand()*1.0/RAND_MAX;
411 color = color*(1/max(max(color.r, color.g), color.b));
413 for(map<Train *, GL::Color>::const_iterator j=train_colors.begin(); j!=train_colors.end(); ++j)
415 float dr = color.r-j->second.r;
416 float dg = color.g-j->second.g;
417 float db = color.b-j->second.b;
418 float d_sq = dr*dr+dg*dg+db*db;
422 if(min_d_sq>best_d_sq)
425 best_d_sq = min_d_sq;
428 train_colors[&train] = best_color;
431 void Engineer::sighandler(int sig)
433 if(sig==SIGSEGV || sig==SIGILL || sig==SIGFPE || sig==SIGABRT)
435 signal(sig, SIG_DFL);
436 IO::print(IO::cerr, "Fatal signal received, terminating\n");
437 const map<unsigned, Train *> &trains = layout.get_trains();
438 for(map<unsigned, Train *>::const_iterator i=trains.begin(); i!=trains.end(); ++i)
439 layout.get_driver().set_loco_speed(i->first, 0);
440 layout.get_driver().flush();
443 else if(sig==SIGTERM || sig==SIGINT)