source/engineer/engineer.cpp

   1 /* $Id$
   2
   3 This file is part of the MSP Märklin suite
   4 Copyright © 2006-2010 Mikkosoft Productions, Mikko Rasa
   5 Distributed under the GPL
   6 */
   7
   8 #include <cmath>
   9 #include <limits>
  10 #include <signal.h>
  11 #include <msp/core/except.h>
  12 #include <msp/fs/stat.h>
  13 #include <msp/gbase/display.h>
  14 #include <msp/gbase/window.h>
  15 #include <msp/gl/blend.h>
  16 #include <msp/gl/framebuffer.h>
  17 #include <msp/gl/matrix.h>
  18 #include <msp/gl/misc.h>
  19 #include <msp/gl/tests.h>
  20 #include <msp/gl/transform.h>
  21 #include <msp/io/print.h>
  22 #include <msp/strings/formatter.h>
  23 #include <msp/time/units.h>
  24 #include "libmarklin/driver.h"
  25 #include "libmarklin/tracktype.h"
  26 #include "engineer.h"
  27 #include "mainpanel.h"
  28 #include "trainpanel.h"
  29 #include "trainproperties.h"
  30
  31 using namespace std;
  32 using namespace Marklin;
  33 using namespace Msp;
  34
  35 Engineer::Engineer(int argc, char **argv):
  36         options(argc, argv),
  37         window(options.screen_w, options.screen_h, options.fullscreen),
  38         layout(catalogue, (options.driver.empty() ? 0 : Driver::create(options.driver))),
  39         layout_3d(layout),
  40         server(0),
  41         pipeline(window.get_width(), window.get_height(), false),
  42         placing_train(0),
  43         placing_block(0),
  44         placing_entry(0)
  45 {
  46         // Setup GUI
  47         window.set_title("Railroad Engineer");
  48         window.signal_close.connect(sigc::bind(sigc::mem_fun(this, &Engineer::exit), 0));
  49
  50         DataFile::load(ui_res, "marklin.res");
  51         root = new GLtk::Root(ui_res, window);
  52         root->signal_button_press.connect(sigc::mem_fun(this, &Engineer::button_press));
  53         root->signal_pointer_motion.connect(sigc::mem_fun(this, &Engineer::pointer_motion));
  54         root->set_visible(true);
  55
  56         main_panel = new MainPanel(*this, ui_res);
  57         root->add(*main_panel);
  58         main_panel->set_position(0, window.get_height()-main_panel->get_geometry().h);
  59         main_panel->set_visible(true);
  60
  61         // Setup railroad control
  62         DataFile::load(catalogue, "tracks.dat");
  63         DataFile::load(catalogue, "locos.dat");
  64         DataFile::load(layout, options.layout_fn);
  65
  66         layout.signal_train_added.connect(sigc::mem_fun(this, &Engineer::train_added));
  67         layout.signal_block_reserved.connect(sigc::mem_fun(this, &Engineer::block_reserved));
  68         if(FS::exists("engineer.state"))
  69                 DataFile::load(layout, "engineer.state");
  70
  71         if(options.network)
  72         {
  73                 server = new Server(layout);
  74                 server->use_event_dispatcher(event_disp);
  75         }
  76
  77         layout.get_driver().signal_sensor.connect(sigc::mem_fun(this, &Engineer::sensor_event));
  78
  79         // Setup 3D view
  80         DataFile::load(arrow_mesh, "arrow.mesh");
  81
  82         overlay = new Overlay3D(window, camera, ui_res.get_default_font());
  83
  84         pipeline.set_camera(&camera);
  85         pipeline.add_renderable(layout_3d.get_scene());
  86
  87         light.set_position(0, -0.259, 0.966, 0);
  88         lighting.attach(0, light);
  89
  90         GL::PipelinePass &pass = pipeline.add_pass(0);
  91         pass.depth_test = &GL::DepthTest::lequal();
  92         pass.lighting = &lighting;
  93
  94         view_all();
  95
  96         // Catch various signals so we can stop the trains in case we get terminated
  97         catch_signal(SIGINT);
  98         catch_signal(SIGTERM);
  99         catch_signal(SIGSEGV);
 100         catch_signal(SIGILL);
 101         catch_signal(SIGFPE);
 102         catch_signal(SIGABRT);
 103 }
 104
 105 Engineer::~Engineer()
 106 {
 107         const map<unsigned, Train *> &trains = layout.get_trains();
 108         for(map<unsigned, Train *>::const_iterator i=trains.begin(); i!=trains.end(); ++i)
 109                 i->second->set_speed(0);
 110         layout.get_driver().flush();
 111
 112         if(!options.simulate)
 113                 layout.save_trains("engineer.state");
 114
 115         delete overlay;
 116         delete root;
 117
 118         delete server;
 119 }
 120
 121 void Engineer::place_train(Train &train)
 122 {
 123         placing_train = &train;
 124         placing_block = 0;
 125         main_panel->set_status_text("Select location");
 126 }
 127
 128 int Engineer::main()
 129 {
 130         window.show();
 131
 132         return Application::main();
 133 }
 134
 135 void Engineer::tick()
 136 {
 137         window.get_display().tick();
 138
 139         layout.tick();
 140         event_disp.tick(Time::zero);
 141
 142         for(list<Train *>::iterator i=new_trains.begin(); i!=new_trains.end(); ++i)
 143                 overlay->set_label(layout_3d.get_train(**i), (*i)->get_name());
 144         new_trains.clear();
 145
 146         GL::clear(GL::COLOR_BUFFER_BIT|GL::DEPTH_BUFFER_BIT);
 147
 148         pipeline.render_all();
 149         {
 150                 GL::Bind blend(GL::Blend::alpha());
 151                 overlay->render(0);
 152         }
 153
 154         if(placing_train && placing_block)
 155         {
 156                 GL::PushMatrix push_mat;
 157
 158                 const Marklin::Block::Endpoint &bep = placing_block->get_endpoints()[placing_entry];
 159                 float rot = bep.track->get_endpoint_direction(bep.track_ep);
 160                 Point pos = bep.track->get_endpoint_position(bep.track_ep);
 161
 162                 GL::translate(pos.x, pos.y, pos.z+0.03);
 163                 GL::rotate(rot*180/M_PI+180, 0, 0, 1);
 164
 165                 arrow_mesh.draw();
 166         }
 167
 168         const GLtk::Geometry &rgeom = root->get_geometry();
 169         GL::matrix_mode(GL::PROJECTION);
 170         GL::load_identity();
 171         GL::ortho_bottomleft(rgeom.w, rgeom.h);
 172         GL::matrix_mode(GL::MODELVIEW);
 173         GL::load_identity();
 174
 175         {
 176                 GL::Bind blend(GL::Blend::alpha());
 177                 root->render();
 178                 GL::Texture::unbind();
 179         }
 180
 181         window.swap_buffers();
 182 }
 183
 184 void Engineer::button_press(int x, int y, unsigned btn, unsigned)
 185 {
 186         if(placing_train)
 187         {
 188                 if(btn==1 && placing_block && !placing_block->get_train())
 189                 {
 190                         reset_block_color(*placing_block);
 191
 192                         placing_train->place(*placing_block, placing_entry);
 193                         placing_train = 0;
 194                         main_panel->set_status_text(string());
 195                 }
 196                 else if(btn==3)
 197                 {
 198                         const vector<Block::Endpoint> &endpoints = placing_block->get_endpoints();
 199                         placing_entry = (placing_entry+1)%endpoints.size();
 200                 }
 201         }
 202         else
 203         {
 204                 Track3D *t3d = pick_track(x, window.get_height()-y-1);
 205                 if(t3d)
 206                 {
 207                         Track &track = t3d->get_track();
 208                         if(track.get_turnout_id())
 209                         {
 210                                 Block &block = layout.get_block_by_track(track);
 211                                 if(block.get_train() && !block.get_train()->free_block(block))
 212                                         main_panel->set_status_text("Turnout busy");
 213                                 else
 214                                 {
 215                                         unsigned paths = track.get_type().get_paths();
 216                                         unsigned i = track.get_active_path()+1;
 217                                         while(!(paths&(1<<i)))
 218                                         {
 219                                                 if(!(paths>>i))
 220                                                         i = 0;
 221                                                 else
 222                                                         ++i;
 223                                         }
 224                                         track.set_active_path(i);
 225                                 }
 226                         }
 227                         /*else if(simulate)
 228                         {
 229                                 if(unsigned sid=track->get_track().get_sensor_id())
 230                                 {
 231                                         Sensor &sensor = control.get_sensor(sid);
 232                                         control.signal_sensor_event.emit(sid, !sensor.get_state());
 233                                 }
 234                         }*/
 235                 }
 236         }
 237 }
 238
 239 void Engineer::pointer_motion(int x, int y)
 240 {
 241         if(placing_train)
 242         {
 243                 Track3D *track = pick_track(x, window.get_height()-y-1);
 244                 if(track)
 245                 {
 246                         Block &block = layout.get_block_by_track(track->get_track());
 247                         if(&block!=placing_block)
 248                         {
 249                                 if(placing_block)
 250                                         reset_block_color(*placing_block);
 251                                 placing_block = &block;
 252                                 placing_entry = 0;
 253                                 set_block_color(*placing_block, GL::Color(0.5, 1, 0.7));
 254                         }
 255                 }
 256         }
 257 }
 258
 259 void Engineer::view_all()
 260 {
 261         const list<Track3D *> &tracks = layout_3d.get_tracks();
 262
 263         float view_aspect = float(window.get_width()-200)/window.get_height();
 264         float view_height = tan(camera.get_field_of_view()/2)*2;
 265         float best_score = 0;
 266         GL::Vector3 pos;
 267         GL::Vector3 up;
 268         for(float angle=0; angle<M_PI; angle+=0.01)
 269         {
 270                 float min_x = 0;
 271                 float max_x = 0;
 272                 float min_y = 0;
 273                 float max_y = 0;
 274                 for(list<Track3D *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
 275                 {
 276                         Point minp, maxp;
 277                         (*i)->get_bounds(angle, minp, maxp);
 278                         min_x = min(min_x, minp.x);
 279                         max_x = max(max_x, maxp.x);
 280                         min_y = min(min_y, minp.y);
 281                         max_y = max(max_y, maxp.y);
 282                 }
 283
 284                 float width = max_x-min_x;
 285                 float height = max_y-min_y;
 286                 float aspect = width/height;
 287                 float score = min(aspect/view_aspect, view_aspect/aspect);
 288
 289                 if(score>best_score)
 290                 {
 291                         best_score = score;
 292
 293                         float size = max(width/view_aspect, height);
 294                         float c = cos(angle);
 295                         float s = sin(angle);
 296                         float x = (min_x+max_x)/2-size*105/window.get_height();
 297                         float y = (min_y+max_y)/2;
 298                         float z = max(size*1.05/view_height, 0.15);
 299
 300                         pos = GL::Vector3(c*x-s*y, s*x+c*y, z);
 301                         up = GL::Vector3(-s, c, 0);
 302                 }
 303         }
 304
 305         camera.set_position(pos);
 306         camera.set_up_direction(up);
 307         camera.set_look_direction(GL::Vector3(0, 0, -1));
 308 }
 309
 310 void Engineer::set_block_color(const Block &block, const GL::Color &color)
 311 {
 312         (void)block; (void)color;
 313 }
 314
 315 void Engineer::reset_block_color(const Block &block)
 316 {
 317         if(unsigned sid=block.get_sensor_id())
 318         {
 319                 if(layout.get_driver().get_sensor(sid))
 320                 {
 321                         set_block_color(block, GL::Color(1, 0.5, 0.3));
 322                         return;
 323                 }
 324         }
 325
 326         if(block.get_train())
 327                 set_block_color(block, GL::Color(1, 1, 0.3));
 328         else
 329                 set_block_color(block, GL::Color(1, 1, 1));
 330 }
 331
 332 void Engineer::sensor_event(unsigned addr, bool)
 333 {
 334         const set<Block *> &blocks = layout.get_blocks();
 335         for(set<Block *>::const_iterator i=blocks.begin(); i!=blocks.end(); ++i)
 336                 if((*i)->get_sensor_id()==addr)
 337                         reset_block_color(**i);
 338 }
 339
 340 void Engineer::block_reserved(const Block &block, const Train *)
 341 {
 342         reset_block_color(block);
 343 }
 344
 345 Track3D *Engineer::pick_track(int x, int y)
 346 {
 347         float view_height = tan(camera.get_field_of_view()/2)*2;
 348         float xx = ((float(x)-window.get_width()/2)/window.get_height())*view_height;
 349         float yy = (float(y)/window.get_height()-0.5)*view_height;
 350         float size = 4.0/window.get_height()*view_height;
 351
 352         camera.apply();
 353
 354         return layout_3d.pick_track(xx, yy, size);
 355 }
 356
 357 void Engineer::train_added(Train &train)
 358 {
 359         TrainPanel *tpanel = new TrainPanel(*this, ui_res, train);
 360         root->add(*tpanel);
 361         int y = main_panel->get_geometry().y;
 362         for(list<TrainPanel *>::iterator i=train_panels.begin(); i!=train_panels.end(); ++i)
 363                 y -= (*i)->get_geometry().h;
 364         tpanel->set_position(0, y-tpanel->get_geometry().h);
 365         train_panels.push_back(tpanel);
 366         tpanel->set_visible(true);
 367
 368         new_trains.push_back(&train);
 369 }
 370
 371 void Engineer::sighandler(int sig)
 372 {
 373         if(sig==SIGSEGV || sig==SIGILL || sig==SIGFPE || sig==SIGABRT)
 374         {
 375                 signal(sig, SIG_DFL);
 376                 IO::print(IO::cerr, "Fatal signal received, terminating\n");
 377                 const map<unsigned, Train *> &trains = layout.get_trains();
 378                 for(map<unsigned, Train *>::const_iterator i=trains.begin(); i!=trains.end(); ++i)
 379                         i->second->set_speed(0);
 380                 layout.get_driver().flush();
 381                 raise(sig);
 382         }
 383         else if(sig==SIGTERM || sig==SIGINT)
 384                 exit(0);
 385 }
 386
 387 Application::RegApp<Engineer> Engineer::reg;