source/engineer/engineer.cpp

   1 #include <algorithm>
   2 #include <cmath>
   3 #include <cstdlib>
   4 #include <limits>
   5 #include <signal.h>
   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/projection.h>
  15 #include <msp/gl/tests.h>
  16 #include <msp/io/print.h>
  17 #include <msp/strings/format.h>
  18 #include <msp/time/units.h>
  19 #include <msp/time/utils.h>
  20 #include "libr2c2/driver.h"
  21 #include "libr2c2/tracktype.h"
  22 #include "3d/path.h"
  23 #include "3d/track.h"
  24 #include "3d/vehicle.h"
  25 #include "engineer.h"
  26 #include "mainpanel.h"
  27 #include "trainpanel.h"
  28 #include "trainproperties.h"
  29 #include "trainview.h"
  30
  31 using namespace std;
  32 using namespace R2C2;
  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         keyboard(window),
  39         mouse(window),
  40         ui_res("r2c2.res"),
  41         layout(catalogue, (options.driver.empty() ? 0 : Driver::create(options.driver))),
  42         layout_3d(layout),
  43         server(0),
  44         pipeline(window.get_width(), window.get_height(), false),
  45         picking(false),
  46         picking_track(0),
  47         picking_entry(0),
  48         picking_path(0),
  49         pointer_moved(false)
  50 {
  51         // Setup GUI
  52         window.set_title("Railroad Engineer");
  53         window.signal_close.connect(sigc::bind(sigc::mem_fun(this, &Engineer::exit), 0));
  54
  55         root = new GLtk::Root(ui_res, window);
  56         mouse.signal_button_press.connect(sigc::mem_fun(this, &Engineer::button_press));
  57         mouse.signal_axis_motion.connect(sigc::mem_fun(this, &Engineer::axis_motion));
  58         root->set_visible(true);
  59
  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);
  64
  65         overlay = new Overlay3D(ui_res.get_default_font());
  66
  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);
  72
  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_block_state_changed.connect(sigc::hide<1>(sigc::mem_fun(this, &Engineer::reset_block_color)));
  76         layout.signal_emergency.connect(sigc::mem_fun(this, &Engineer::set_status));
  77
  78         if(FS::exists(options.state_fn))
  79                 DataFile::load(layout, options.state_fn);
  80
  81         if(options.network)
  82         {
  83                 server = new Server(layout);
  84                 server->use_event_dispatcher(event_disp);
  85         }
  86
  87         // Setup 3D view
  88         DataFile::load(arrow_mesh, "arrow.mesh");
  89
  90         pipeline.set_camera(&camera);
  91         pipeline.add_renderable_for_pass(layout_3d.get_scene(), 0);
  92         pipeline.add_renderable_for_pass(layout_3d.get_path_scene(), "unlit");
  93         pipeline.add_renderable_for_pass(*overlay, "overlay");
  94
  95         light.set_position(GL::Vector4(0, -0.259, 0.966, 0));
  96         light.set_diffuse(GL::Color(0.9));
  97         lighting.set_ambient(GL::Color(0.4));
  98         lighting.attach(0, light);
  99
 100         GL::Pipeline::Pass *pass = &pipeline.add_pass(0);
 101         pass->set_depth_test(&GL::DepthTest::lequal());
 102         pass->set_lighting(&lighting);
 103
 104         pass = &pipeline.add_pass("unlit");
 105         pass->set_depth_test(&GL::DepthTest::lequal());
 106
 107         pass = &pipeline.add_pass("overlay");
 108         pass->set_blend(&GL::Blend::alpha());
 109
 110         view_all();
 111
 112         // Catch various signals so we can stop the trains in case we get terminated
 113         catch_signal(SIGINT);
 114         catch_signal(SIGTERM);
 115         catch_signal(SIGSEGV);
 116         catch_signal(SIGILL);
 117         catch_signal(SIGFPE);
 118         catch_signal(SIGABRT);
 119 }
 120
 121 Engineer::~Engineer()
 122 {
 123         const map<unsigned, Train *> &trains = layout.get_trains();
 124         for(map<unsigned, Train *>::const_iterator i=trains.begin(); i!=trains.end(); ++i)
 125                 layout.get_driver().set_loco_speed(i->first, 0);
 126         layout.get_driver().flush();
 127
 128         if(!options.simulate)
 129         {
 130                 layout.save_dynamic(options.state_fn+".tmp");
 131                 FS::rename(options.state_fn+".tmp", options.state_fn);
 132         }
 133
 134         delete overlay;
 135         delete root;
 136
 137         delete server;
 138 }
 139
 140 void Engineer::set_status(const string &text)
 141 {
 142         main_panel->set_status_text(text);
 143         status_timeout = Time::now()+10*Time::sec;
 144 }
 145
 146 void Engineer::rearrange_panels()
 147 {
 148         int y = main_panel->get_geometry().y;
 149         for(list<TrainPanel *>::iterator i=train_panels.begin(); i!=train_panels.end(); ++i)
 150         {
 151                 y -= (*i)->get_geometry().h;
 152                 (*i)->set_position(0, y);
 153         }
 154 }
 155
 156 void Engineer::add_train_view(TrainView &tv)
 157 {
 158         train_views.push_back(&tv);
 159 }
 160
 161 void Engineer::remove_train_view(TrainView &tv)
 162 {
 163         train_views.erase(remove(train_views.begin(), train_views.end(), &tv), train_views.end());
 164 }
 165
 166 void Engineer::pick(bool with_ep)
 167 {
 168         picking = true;
 169         picking_track = 0;
 170         picking_entry = (with_ep ? 0 : -1);
 171 }
 172
 173 int Engineer::main()
 174 {
 175         window.show();
 176
 177         return Application::main();
 178 }
 179
 180 void Engineer::tick()
 181 {
 182         window.get_display().tick();
 183
 184         layout.tick();
 185         event_disp.tick(Time::zero);
 186
 187         for(list<TrainView *>::iterator i=train_views.begin(); i!=train_views.end(); ++i)
 188                 (*i)->prepare();
 189
 190         if(status_timeout && Time::now()>status_timeout)
 191         {
 192                 main_panel->set_status_text(string());
 193                 status_timeout = Time::TimeStamp();
 194         }
 195
 196         GL::Framebuffer::system().clear(GL::COLOR_BUFFER_BIT|GL::DEPTH_BUFFER_BIT);
 197
 198         pipeline.render();
 199
 200         if(pointer_moved)
 201         {
 202                 pointer_moved = false;
 203
 204                 if(picking)
 205                 {
 206                         Track *track = pick_track(pointer);
 207                         if(track && track!=picking_track)
 208                         {
 209                                 picking_track = track;
 210                                 if(picking_entry>=0)
 211                                         picking_entry = 0;
 212
 213                                 delete picking_path;
 214                                 picking_path = new Path3D(layout_3d.get_track(*track));
 215                                 if(picking_entry>=0)
 216                                         picking_path->set_mask(picking_track->get_type().get_endpoint(picking_entry).paths);
 217                                 else
 218                                         picking_path->set_mask(picking_track->get_type().get_paths());
 219                                 picking_path->set_color(GL::Color(0));
 220                                 picking_path->set_layer(1);
 221                         }
 222                 }
 223         }
 224
 225         if(picking && picking_track && picking_entry>=0)
 226         {
 227                 camera.apply();
 228                 GL::MatrixStack::Push push_mat(GL::MatrixStack::modelview());
 229
 230                 float rot = picking_track->get_endpoint_direction(picking_entry);
 231                 Vector pos = picking_track->get_endpoint_position(picking_entry);
 232
 233                 GL::MatrixStack::modelview() *= GL::Matrix::translation(pos.x, pos.y, pos.z+0.03);
 234                 GL::MatrixStack::modelview() *= GL::Matrix::rotation(rot+M_PI, 0, 0, 1);
 235
 236                 arrow_mesh.draw();
 237         }
 238
 239         root->render();
 240
 241         window.swap_buffers();
 242 }
 243
 244 void Engineer::button_press(unsigned btn)
 245 {
 246         if(picking)
 247         {
 248                 if(btn==1 && picking_track)
 249                 {
 250                         picking = false;
 251                         delete picking_path;
 252                         picking_path = 0;
 253                         signal_pick_done.emit(picking_track, picking_entry);
 254                 }
 255                 else if(btn==3 && picking_entry>=0)
 256                 {
 257                         picking_entry = (picking_entry+1)%picking_track->get_type().get_endpoints().size();
 258                         picking_path->set_mask(picking_track->get_type().get_endpoint(picking_entry).paths);
 259                 }
 260         }
 261         else
 262         {
 263                 Track *track = pick_track(pointer);
 264                 if(track)
 265                 {
 266                         if(track->get_turnout_id())
 267                         {
 268                                 Block &block = track->get_block();
 269                                 if(block.get_train() && !block.get_train()->free_block(block))
 270                                         set_status("Turnout is busy");
 271                                 else
 272                                 {
 273                                         unsigned paths = track->get_type().get_paths();
 274                                         unsigned i = track->get_active_path()+1;
 275                                         while(!(paths&(1<<i)))
 276                                         {
 277                                                 if(!(paths>>i))
 278                                                         i = 0;
 279                                                 else
 280                                                         ++i;
 281                                         }
 282                                         track->set_active_path(i);
 283                                         set_status(format("Turnout %d", track->get_turnout_id()));
 284                                 }
 285                         }
 286                         if(unsigned sid = track->get_sensor_id())
 287                         {
 288                                 if(options.simulate)
 289                                         layout.get_driver().set_sensor(sid, !layout.get_driver().get_sensor(sid));
 290                                 set_status(format("Sensor %d", sid));
 291                         }
 292                 }
 293         }
 294 }
 295
 296 void Engineer::axis_motion(unsigned axis, float value, float)
 297 {
 298         if(axis==0)
 299                 pointer.x = value;
 300         if(axis==1)
 301                 pointer.y = value;
 302         pointer_moved = true;
 303 }
 304
 305 void Engineer::view_all()
 306 {
 307         const Layout3D::TrackMap &tracks = layout_3d.get_tracks();
 308
 309         float view_aspect = float(window.get_width()-200)/window.get_height();
 310         float view_height = tan(camera.get_field_of_view()/2)*2;
 311         float best_score = 0;
 312         GL::Vector3 pos;
 313         GL::Vector3 up;
 314         for(float angle=0; angle<M_PI; angle+=0.01)
 315         {
 316                 float min_x = 0;
 317                 float max_x = 0;
 318                 float min_y = 0;
 319                 float max_y = 0;
 320                 for(Layout3D::TrackMap::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
 321                 {
 322                         Vector minp, maxp;
 323                         i->second->get_bounds(angle, minp, maxp);
 324                         min_x = min(min_x, minp.x);
 325                         max_x = max(max_x, maxp.x);
 326                         min_y = min(min_y, minp.y);
 327                         max_y = max(max_y, maxp.y);
 328                 }
 329
 330                 float width = max_x-min_x;
 331                 float height = max_y-min_y;
 332                 float aspect = width/height;
 333                 float score = min(aspect/view_aspect, view_aspect/aspect);
 334
 335                 if(score>best_score)
 336                 {
 337                         best_score = score;
 338
 339                         float size = max(width/view_aspect, height);
 340                         float c = cos(angle);
 341                         float s = sin(angle);
 342                         float x = (min_x+max_x)/2-size*105/window.get_height();
 343                         float y = (min_y+max_y)/2;
 344                         float z = max(size*1.05/view_height, 0.15);
 345
 346                         pos = GL::Vector3(c*x-s*y, s*x+c*y, z);
 347                         up = GL::Vector3(-s, c, 0);
 348                 }
 349         }
 350
 351         camera.set_position(pos);
 352         camera.set_up_direction(up);
 353         camera.set_look_direction(GL::Vector3(0, 0, -1));
 354         camera.set_aspect(float(window.get_width())/window.get_height());
 355         camera.set_depth_clip(pos.z*0.5, pos.z*1.5);
 356 }
 357
 358 void Engineer::set_block_color(const Block &block, const GL::Color &color)
 359 {
 360         const set<Track *> &tracks = block.get_tracks();
 361         for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
 362                 layout_3d.get_track(**i).get_path().set_color(color);
 363 }
 364
 365 void Engineer::reset_block_color(const Block &block)
 366 {
 367         bool active = block.get_state()>Block::INACTIVE;
 368
 369         if(block.get_train())
 370         {
 371                 GL::Color color;
 372                 map<Train *, GL::Color>::iterator i = train_colors.find(block.get_train());
 373                 if(i!=train_colors.end())
 374                         color = i->second;
 375
 376                 if(active)
 377                         set_block_color(block, color*0.6);
 378                 else
 379                         set_block_color(block, color*0.5+0.5);
 380         }
 381         else if(active)
 382                 set_block_color(block, GL::Color(0.6));
 383         else
 384                 set_block_color(block, GL::Color(1));
 385 }
 386
 387 Track *Engineer::pick_track(const Vector &p)
 388 {
 389         const GL::Vector3 &start = camera.get_position();
 390         GL::Vector4 ray = camera.unproject(GL::Vector4(p.x, p.y, 0, 0));
 391
 392         return layout.pick_track(Vector(start.x, start.y, start.z), Vector(ray.x, ray.y, ray.z));
 393 }
 394
 395 void Engineer::train_added(Train &train)
 396 {
 397         TrainPanel *tpanel = new TrainPanel(*this, train);
 398         root->add(*tpanel);
 399         train_panels.push_back(tpanel);
 400         rearrange_panels();
 401
 402         Vehicle3D &loco3d = layout_3d.get_vehicle(train.get_vehicle(0));
 403         overlay->set_label(loco3d, train.get_name());
 404         train.signal_name_changed.connect(sigc::bind<0>(sigc::mem_fun(overlay, &Overlay3D::set_label), sigc::ref(loco3d)));
 405
 406         GL::Color best_color;
 407         float best_d_sq = 0;
 408         for(unsigned i=0; i<10; ++i)
 409         {
 410                 GL::Color color;
 411                 color.r = rand()*1.0/RAND_MAX;
 412                 color.g = rand()*1.0/RAND_MAX;
 413                 color.b = rand()*1.0/RAND_MAX;
 414                 color = color*(1/max(max(color.r, color.g), color.b));
 415                 float min_d_sq = 3;
 416                 for(map<Train *, GL::Color>::const_iterator j=train_colors.begin(); j!=train_colors.end(); ++j)
 417                 {
 418                         float dr = color.r-j->second.r;
 419                         float dg = color.g-j->second.g;
 420                         float db = color.b-j->second.b;
 421                         float d_sq = dr*dr+dg*dg+db*db;
 422                         if(d_sq<min_d_sq)
 423                                 min_d_sq = d_sq;
 424                 }
 425                 if(min_d_sq>best_d_sq)
 426                 {
 427                         best_color = color;
 428                         best_d_sq = min_d_sq;
 429                 }
 430         }
 431         train_colors[&train] = best_color;
 432 }
 433
 434 void Engineer::sighandler(int sig)
 435 {
 436         if(sig==SIGSEGV || sig==SIGILL || sig==SIGFPE || sig==SIGABRT)
 437         {
 438                 signal(sig, SIG_DFL);
 439                 IO::print(IO::cerr, "Fatal signal received, terminating\n");
 440                 const map<unsigned, Train *> &trains = layout.get_trains();
 441                 for(map<unsigned, Train *>::const_iterator i=trains.begin(); i!=trains.end(); ++i)
 442                         layout.get_driver().set_loco_speed(i->first, 0);
 443                 layout.get_driver().flush();
 444                 raise(sig);
 445         }
 446         else if(sig==SIGTERM || sig==SIGINT)
 447                 exit(0);
 448 }