+/* $Id$
+
+This file is part of the MSP Märklin suite
+Copyright © 2006-2010 Mikkosoft Productions, Mikko Rasa
+Distributed under the GPL
+*/
+
#include <cmath>
#include <limits>
-#include <GL/gl.h>
+#include <signal.h>
#include <msp/core/except.h>
#include <msp/core/getopt.h>
+#include <msp/fs/stat.h>
#include <msp/gbase/display.h>
#include <msp/gbase/window.h>
+#include <msp/gl/blend.h>
+#include <msp/gl/framebuffer.h>
#include <msp/gl/immediate.h>
#include <msp/gl/matrix.h>
+#include <msp/gl/misc.h>
#include <msp/gl/projection.h>
+#include <msp/gl/tests.h>
#include <msp/gl/transform.h>
+#include <msp/io/print.h>
#include <msp/strings/formatter.h>
#include <msp/strings/lexicalcast.h>
#include <msp/strings/regex.h>
+#include <msp/time/units.h>
+#include "libmarklin/except.h"
+#include "libmarklin/tracktype.h"
#include "engineer.h"
#include "mainpanel.h"
#include "trainpanel.h"
using namespace Marklin;
using namespace Msp;
-#include <iostream>
-
Engineer::Engineer(int argc, char **argv):
- screen_w(1280),
- screen_h(960),
- fullscreen(false),
layout(catalogue),
layout_3d(layout),
- no_lighting(false),
+ server(0),
placing_train(0),
placing_block(0),
placing_entry(0),
- simulate(false),
- train_prop(0),
- train_prop_stale(false)
+ simulate(false)
{
+ // Parse options
+ unsigned screen_w = 1280;
+ unsigned screen_h = 960;
+ bool fullscreen = false;
string res;
- bool debug=false;
- string device="/dev/ttyS0";
- unsigned quality=4;
+ bool debug = false;
+ string device = "/dev/ttyS0";
+ bool network = false;
GetOpt getopt;
getopt.add_option('r', "resolution", res, GetOpt::REQUIRED_ARG);
getopt.add_option('f', "fullscreen", fullscreen, GetOpt::NO_ARG);
getopt.add_option('g', "debug", debug, GetOpt::NO_ARG);
getopt.add_option('d', "device", device, GetOpt::REQUIRED_ARG);
- getopt.add_option('q', "quality", quality, GetOpt::REQUIRED_ARG);
getopt.add_option('s', "simulate", simulate, GetOpt::NO_ARG);
- getopt.add_option( "no-lighting", no_lighting, GetOpt::NO_ARG);
+ getopt.add_option('n', "network", network, GetOpt::NO_ARG);
getopt(argc, argv);
+ const vector<string> &args = getopt.get_args();
+ if(args.empty())
+ throw UsageError("No layout given");
+
if(!res.empty())
{
if(RegMatch m=Regex("([1-9][0-9]*)x([1-9][0-9]*)").match(res))
{
- screen_w=lexical_cast<unsigned>(m[1].str);
- screen_h=lexical_cast<unsigned>(m[2].str);
+ screen_w = lexical_cast<unsigned>(m[1].str);
+ screen_h = lexical_cast<unsigned>(m[2].str);
}
else
throw UsageError("Invalid resolution");
}
- if(device!="none")
- control.open(device);
+ // Setup GUI
+ window = new Graphics::SimpleGLWindow(screen_w, screen_h, fullscreen);
+ window->set_title("Railroad Engineer");
+ window->signal_close.connect(sigc::bind(sigc::mem_fun(this, &Engineer::exit), 0));
- control.set_debug(debug);
+ DataFile::load(ui_res, "marklin.res");
+ root = new GLtk::Root(ui_res, *window);
+ root->signal_button_press.connect(sigc::mem_fun(this, &Engineer::button_press));
+ root->signal_pointer_motion.connect(sigc::mem_fun(this, &Engineer::pointer_motion));
+ root->set_visible(true);
+
+ main_panel = new MainPanel(*this, ui_res);
+ root->add(*main_panel);
+ main_panel->set_position(0, window->get_height()-main_panel->get_geometry().h);
+ main_panel->set_visible(true);
- layout_3d.set_quality(quality);
+ // Setup railroad control
+ DataFile::load(catalogue, "tracks.dat");
+ DataFile::load(catalogue, "locos.dat");
+ DataFile::load(layout, args.front());
- catalogue.load("tracks.dat");
+ if(device!="none")
+ control.open(device);
- const vector<string> &args=getopt.get_args();
- if(args.empty())
- throw UsageError("No layout given");
- layout.load(args.front());
+ control.set_debug(debug);
- trfc_mgr=new TrafficManager(control, layout);
+ trfc_mgr = new TrafficManager(control, layout);
+ layout_3d.set_traffic_manager(*trfc_mgr);
+ trfc_mgr->signal_train_added.connect(sigc::mem_fun(this, &Engineer::train_added));
trfc_mgr->signal_block_reserved.connect(sigc::mem_fun(this, &Engineer::block_reserved));
+ if(FS::exists("engineer.state"))
+ DataFile::load(*trfc_mgr, "engineer.state");
- const map<unsigned, Sensor *> &sensors=control.get_sensors();
+ if(network)
+ {
+ server = new Server(*trfc_mgr);
+ server->use_event_dispatcher(event_disp);
+ }
+
+ const map<unsigned, Sensor *> &sensors = control.get_sensors();
for(map<unsigned, Sensor *>::const_iterator i=sensors.begin(); i!=sensors.end(); ++i)
i->second->signal_state_changed.connect(sigc::bind(sigc::mem_fun(this, &Engineer::sensor_event), i->second));
+ // Setup 3D view
+ DataFile::load(arrow_mesh, "arrow.mesh");
+
+ overlay = new Overlay3D(*window, camera, ui_res.get_default_font());
+
+ pipeline = new GL::Pipeline(window->get_width(), window->get_height(), false);
+ pipeline->set_camera(&camera);
+ pipeline->add_renderable(layout_3d.get_scene());
+
+ light.set_position(0, -0.259, 0.966, 0);
+ lighting.attach(0, light);
+
+ GL::PipelinePass &pass = pipeline->add_pass(0);
+ pass.depth_test = &GL::DepthTest::lequal();
+ pass.lighting = &lighting;
+
view_all();
+
+ // Catch various signals so we can stop the trains in case we get terminated
+ catch_signal(SIGINT);
+ catch_signal(SIGTERM);
+ catch_signal(SIGSEGV);
+ catch_signal(SIGILL);
+ catch_signal(SIGFPE);
+ catch_signal(SIGABRT);
}
Engineer::~Engineer()
{
+ const list<Train *> &trains = trfc_mgr->get_trains();
+ for(list<Train *>::const_iterator i=trains.begin(); i!=trains.end(); ++i)
+ (*i)->set_speed(0);
+
+ while(control.get_queue_length())
+ control.tick();
+
+ if(!simulate)
+ trfc_mgr->save("engineer.state");
+
+ delete pipeline;
+ delete overlay;
+ delete root;
+ delete window;
+
delete trfc_mgr;
+ delete server;
}
-Train *Engineer::add_train(unsigned addr)
+void Engineer::place_train(Train &train)
{
- if(addr==0)
- {
- train_prop=new TrainProperties(*this, ui_res, 0);
- root->add(*train_prop);
- train_prop->signal_ok.connect(sigc::mem_fun(this, &Engineer::dismiss_train_prop));
- train_prop_stale=false;
- train_prop->set_visible(true);
-
- return 0;
- }
- else
- {
- Locomotive *loco=new Locomotive(control, addr);
- Train *train=new Train(*trfc_mgr, *loco);
- train->set_name(format("Train %d", trfc_mgr->get_trains().size()));
-
- TrainPanel *tpanel=new TrainPanel(*this, ui_res, *train);
- root->add(*tpanel);
- int y=main_panel->get_geometry().y;
- for(list<TrainPanel *>::iterator i=train_panels.begin(); i!=train_panels.end(); ++i)
- y-=(*i)->get_geometry().h;
- tpanel->set_position(0, y-tpanel->get_geometry().h);
- train_panels.push_back(tpanel);
- tpanel->set_visible(true);
-
- placing_train=train;
- placing_block=0;
- main_panel->set_status_text("Select location");
-
- return train;
- }
+ placing_train = &train;
+ placing_block = 0;
+ main_panel->set_status_text("Select location");
}
int Engineer::main()
{
- dpy=new Graphics::Display;
-
- Graphics::WindowOptions wopt;
- wopt.width=screen_w;
- wopt.height=screen_h;
- wopt.fullscreen=fullscreen;
- wnd=new Graphics::Window(*dpy, wopt);
-
- Graphics::GLOptions glopt;
- //glopt.multisample=4;
- glc=new Graphics::GLContext(*wnd, glopt);
-
- wnd->signal_close.connect(sigc::bind(sigc::mem_fun(this, &Engineer::exit), 0));
- wnd->signal_button_press.connect(sigc::mem_fun(this, &Engineer::button_press));
- wnd->signal_button_release.connect(sigc::mem_fun(this, &Engineer::button_release));
- wnd->signal_pointer_motion.connect(sigc::mem_fun(this, &Engineer::pointer_motion));
-
- glEnableClientState(GL_VERTEX_ARRAY);
- glColorMaterial(GL_FRONT_AND_BACK, GL_AMBIENT_AND_DIFFUSE);
- glEnable(GL_COLOR_MATERIAL);
- glDepthFunc(GL_LEQUAL);
- glEnable(GL_BLEND);
- glBlendFunc(GL_SRC_ALPHA, GL_ONE_MINUS_SRC_ALPHA);
-
- DataFile::load(ui_res, "engineer.res");
- root=new GLtk::Root(ui_res, *wnd);
- root->set_visible(true);
-
- list<GL::Texture *> texs=ui_res.get_list<GL::Texture>();
- for(list<GL::Texture *>::iterator i=texs.begin(); i!=texs.end(); ++i)
- {
- (*i)->set_min_filter(GL::NEAREST);
- (*i)->set_mag_filter(GL::NEAREST);
- }
-
- main_panel=new MainPanel(*this, ui_res);
- root->add(*main_panel);
- main_panel->set_position(0, screen_h-main_panel->get_geometry().h);
- main_panel->set_visible(true);
+ window->show();
- wnd->show();
-
- Application::main();
-
- delete glc;
- delete wnd;
- delete dpy;
-
- return exit_code;
+ return Application::main();
}
void Engineer::tick()
{
- dpy->tick();
+ window->get_display().tick();
control.tick();
trfc_mgr->tick();
+ event_disp.tick(Time::zero);
- glClear(GL_COLOR_BUFFER_BIT|GL_DEPTH_BUFFER_BIT);
+ for(list<Train *>::iterator i=new_trains.begin(); i!=new_trains.end(); ++i)
+ overlay->set_label(layout_3d.get_train(**i), (*i)->get_name());
+ new_trains.clear();
- project_3d();
- glLoadIdentity();
- glRotatef(-cam_rot*180/M_PI, 0, 0, 1);
- glTranslatef(-cam_pos.x, -cam_pos.y, -cam_pos.z);
+ GL::clear(GL::COLOR_BUFFER_BIT|GL::DEPTH_BUFFER_BIT);
- if(!no_lighting)
+ pipeline->render_all();
{
- glEnable(GL_LIGHTING);
- glEnable(GL_LIGHT0);
- float params[4];
- params[0]=0;
- params[1]=-0.2;
- params[2]=1;
- params[3]=0;
- glLightfv(GL_LIGHT0, GL_POSITION, params);
- }
-
- //glEnable(GL_DEPTH_TEST);
- glEnable(GL_MULTISAMPLE);
-
- layout_3d.render();
-
- glDisable(GL_LIGHTING);
- glColor4f(1, 1, 1, 1);
- const list<Track3D *> <racks=layout_3d.get_tracks();
- for(list<Track3D *>::const_iterator i=ltracks.begin(); i!=ltracks.end(); ++i)
- {
- Track &track=(*i)->get_track();
- if(track.get_turnout_id())
- {
- Turnout &trnt=control.get_turnout(track.get_turnout_id());
- (*i)->render_route(trnt.get_route());
- }
- else
- (*i)->render_route(-1);
+ GL::Bind blend(GL::Blend::alpha());
+ overlay->render(0);
}
if(placing_train && placing_block)
{
- GL::push_matrix();
+ GL::PushMatrix push_mat;
- const Marklin::Block::Endpoint &bep=placing_block->get_endpoints()[placing_entry];
- float rot=bep.track->get_endpoint_direction(bep.track_ep);
- Point pos=bep.track->get_endpoint_position(bep.track_ep);
+ const Marklin::Block::Endpoint &bep = placing_block->get_endpoints()[placing_entry];
+ float rot = bep.track->get_endpoint_direction(bep.track_ep);
+ Point pos = bep.track->get_endpoint_position(bep.track_ep);
GL::translate(pos.x, pos.y, pos.z+0.03);
GL::rotate(rot*180/M_PI+180, 0, 0, 1);
- GL::Texture::unbind();
- GL::Immediate imm((GL::COLOR4_UBYTE, GL::VERTEX2));
- imm.color(1.0f, 1.0f, 1.0f);
- imm.begin(GL::TRIANGLE_FAN);
- imm.vertex(0.08, 0);
- imm.vertex(0.05, 0.03);
- imm.vertex(0.05, 0.01);
- imm.vertex(0, 0.01);
- imm.vertex(0, -0.01);
- imm.vertex(0.05, -0.01);
- imm.vertex(0.05, -0.03);
- imm.end();
-
- GL::pop_matrix();
+ arrow_mesh.draw();
}
+ const GLtk::Geometry &rgeom = root->get_geometry();
GL::matrix_mode(GL::PROJECTION);
GL::load_identity();
- GL::ortho_bottomleft(screen_w, screen_h);
+ GL::ortho_bottomleft(rgeom.w, rgeom.h);
GL::matrix_mode(GL::MODELVIEW);
GL::load_identity();
- glDisable(GL_DEPTH_TEST);
- glDisable(GL_LIGHTING);
- glDisable(GL_MULTISAMPLE);
-
- root->render();
-
- if(train_prop_stale)
{
- delete train_prop;
- train_prop=0;
+ GL::Bind blend(GL::Blend::alpha());
+ root->render();
+ GL::Texture::unbind();
}
- glc->swap_buffers();
-}
-
-void Engineer::key_press(unsigned key, unsigned mod, wchar_t ch)
-{
- if(train_prop)
- train_prop->key_press(key, mod, ch);
+ window->swap_buffers();
}
void Engineer::button_press(int x, int y, unsigned btn, unsigned)
{
if(placing_train)
{
- if(btn==1 && placing_block)
+ if(btn==1 && placing_block && !placing_block->get_train())
{
- set_block_color(*placing_block, GL::Color(1, 1, 1));
+ reset_block_color(*placing_block);
- placing_train->place(placing_block, placing_entry);
- placing_train=0;
+ placing_train->place(*placing_block, placing_entry);
+ placing_train = 0;
main_panel->set_status_text(string());
}
else if(btn==3)
{
- const vector<Block::Endpoint> &endpoints=placing_block->get_endpoints();
- placing_entry=(placing_entry+1)%endpoints.size();
+ const vector<Block::Endpoint> &endpoints = placing_block->get_endpoints();
+ placing_entry = (placing_entry+1)%endpoints.size();
}
}
else
{
- Track3D *track=pick_track(x, screen_h-y-1);
+ Track3D *track = pick_track(x, window->get_height()-y-1);
if(track)
{
if(unsigned tid=track->get_track().get_turnout_id())
{
- Turnout &turnout=control.get_turnout(tid);
- turnout.set_route(1-turnout.get_route());
+ Turnout &turnout = control.get_turnout(tid);
+ try
+ {
+ turnout.set_path((turnout.get_path()+1)%track->get_track().get_type().get_n_paths());
+ main_panel->set_status_text(format("Turnout %d switched", turnout.get_address()));
+ }
+ catch(const TurnoutBusy &e)
+ {
+ main_panel->set_status_text(e.what());
+ }
}
else if(simulate)
{
if(unsigned sid=track->get_track().get_sensor_id())
{
- Sensor &sensor=control.get_sensor(sid);
+ Sensor &sensor = control.get_sensor(sid);
control.signal_sensor_event.emit(sid, !sensor.get_state());
}
}
}
}
-void Engineer::button_release(int, int, unsigned, unsigned)
-{
-}
-
void Engineer::pointer_motion(int x, int y)
{
if(placing_train)
{
- Track3D *track=pick_track(x, screen_h-y-1);
- if(track && placing_train)
+ Track3D *track = pick_track(x, window->get_height()-y-1);
+ if(track)
{
- Block &block=trfc_mgr->get_block_by_track(track->get_track());
+ Block &block = trfc_mgr->get_block_by_track(track->get_track());
if(&block!=placing_block)
{
if(placing_block)
- set_block_color(*placing_block, GL::Color(1, 1, 1));
- placing_block=█
- placing_entry=0;
+ reset_block_color(*placing_block);
+ placing_block = █
+ placing_entry = 0;
set_block_color(*placing_block, GL::Color(0.5, 1, 0.7));
}
}
- else if(track && track->get_track().get_turnout_id())
- main_panel->set_status_text(format("Turnout %d", track->get_track().get_turnout_id()));
- else if(!placing_train)
- main_panel->set_status_text(string());
}
}
void Engineer::view_all()
{
- const list<Track3D *> &tracks=layout_3d.get_tracks();
+ const list<Track3D *> &tracks = layout_3d.get_tracks();
- cam_rot=0;
- float best_height=-1;
- float mid_x=0;
- float mid_y=0;
+ float view_aspect = float(window->get_width()-200)/window->get_height();
+ float view_height = tan(camera.get_field_of_view()/2)*2;
+ float best_score = 0;
+ GL::Vector3 pos;
+ GL::Vector3 up;
for(float angle=0; angle<M_PI; angle+=0.01)
{
- float min_x=0;
- float max_x=0;
- float min_y=0;
- float max_y=0;
+ float min_x = 0;
+ float max_x = 0;
+ float min_y = 0;
+ float max_y = 0;
for(list<Track3D *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
{
Point minp, maxp;
(*i)->get_bounds(angle, minp, maxp);
- min_x=min(min_x, minp.x);
- max_x=max(max_x, maxp.x);
- min_y=min(min_y, minp.y);
- max_y=max(max_y, maxp.y);
+ min_x = min(min_x, minp.x);
+ max_x = max(max_x, maxp.x);
+ min_y = min(min_y, minp.y);
+ max_y = max(max_y, maxp.y);
}
- float width=max_x-min_x;
- float height=max_y-min_y;
- height=max(height, width);
+ float width = max_x-min_x;
+ float height = max_y-min_y;
+ float aspect = width/height;
+ float score = min(aspect/view_aspect, view_aspect/aspect);
- if(height<best_height || best_height<0)
+ if(score>best_score)
{
- cam_rot=angle;
- best_height=height;
- mid_x=(min_x+max_x)/2;
- mid_y=(min_y+max_y)/2;
+ best_score = score;
+
+ float size = max(width/view_aspect, height);
+ float c = cos(angle);
+ float s = sin(angle);
+ float x = (min_x+max_x)/2-size*105/window->get_height();
+ float y = (min_y+max_y)/2;
+ float z = max(size*1.05/view_height, 0.15);
+
+ pos = GL::Vector3(c*x-s*y, s*x+c*y, z);
+ up = GL::Vector3(-s, c, 0);
}
}
- float c=cos(cam_rot);
- float s=sin(cam_rot);
- cam_pos.x=c*mid_x-s*mid_y;
- cam_pos.y=s*mid_x+c*mid_y;
- cam_pos.z=max(best_height*1.05/0.82843, 0.15);
+ camera.set_position(pos);
+ camera.set_up_direction(up);
+ camera.set_look_direction(GL::Vector3(0, 0, -1));
}
void Engineer::set_block_color(const Block &block, const GL::Color &color)
{
- const set<Track *> &tracks=block.get_tracks();
- for(set<Track *>::const_iterator i=tracks.begin(); i!=tracks.end(); ++i)
- layout_3d.get_track(**i).set_color(color);
-}
-
-void Engineer::sensor_event(bool state, Sensor *sensor)
-{
- const list<Track3D *> <racks=layout_3d.get_tracks();
- for(list<Track3D *>::const_iterator i=ltracks.begin(); i!=ltracks.end(); ++i)
- if((*i)->get_track().get_sensor_id()==sensor->get_address())
- {
- Block &block=trfc_mgr->get_block_by_track((*i)->get_track());
- if(state)
- (*i)->set_color(GL::Color(1, 0.5, 0.3));
- else if(block.get_train())
- set_block_color(block, GL::Color(1, 1, 0.3));
- else
- (*i)->set_color(GL::Color(1, 1, 1));
- }
+ (void)block;
+ (void)color;
}
-void Engineer::block_reserved(const Block &block, const Train *train)
+void Engineer::reset_block_color(const Block &block)
{
if(unsigned sid=block.get_sensor_id())
{
- Sensor &sensor=control.get_sensor(sid);
+ Sensor &sensor = control.get_sensor(sid);
if(sensor.get_state())
+ {
+ set_block_color(block, GL::Color(1, 0.5, 0.3));
return;
+ }
}
- if(train)
+ if(block.get_train())
set_block_color(block, GL::Color(1, 1, 0.3));
else
set_block_color(block, GL::Color(1, 1, 1));
}
-void Engineer::project_3d()
+void Engineer::sensor_event(bool, Sensor *sensor)
+{
+ const list<Block *> &blocks = trfc_mgr->get_blocks();
+ for(list<Block *>::const_iterator i=blocks.begin(); i!=blocks.end(); ++i)
+ if((*i)->get_sensor_id()==sensor->get_address())
+ reset_block_color(**i);
+}
+
+void Engineer::block_reserved(const Block &block, const Train *)
{
- glMatrixMode(GL_PROJECTION);
- glLoadIdentity();
- float offset=200.0/screen_w*0.055228;
- glFrustum(-0.055228-offset, 0.055228-offset, -0.041421, 0.041421, 0.1, 10);
- glMatrixMode(GL_MODELVIEW);
+ reset_block_color(block);
}
Track3D *Engineer::pick_track(int x, int y)
{
- float xx=(static_cast<float>(x-static_cast<int>(screen_w)/2-100)/screen_h)*0.82843;
- float yy=(static_cast<float>(y)/screen_h-0.5)*0.82843;
- float size=4.0/screen_h*0.82843;
+ float view_height = tan(camera.get_field_of_view()/2)*2;
+ float xx = ((float(x)-window->get_width()/2)/window->get_height())*view_height;
+ float yy = (float(y)/window->get_height()-0.5)*view_height;
+ float size = 4.0/window->get_height()*view_height;
- project_3d();
- glLoadIdentity();
- glRotatef(-cam_rot*180/M_PI, 0, 0, 1);
- glTranslatef(-cam_pos.x, -cam_pos.y, -cam_pos.z);
+ camera.apply();
return layout_3d.pick_track(xx, yy, size);
}
-void Engineer::dismiss_train_prop()
+void Engineer::train_added(Train &train)
{
- train_prop_stale=true;
+ TrainPanel *tpanel = new TrainPanel(*this, ui_res, train);
+ root->add(*tpanel);
+ int y = main_panel->get_geometry().y;
+ for(list<TrainPanel *>::iterator i=train_panels.begin(); i!=train_panels.end(); ++i)
+ y -= (*i)->get_geometry().h;
+ tpanel->set_position(0, y-tpanel->get_geometry().h);
+ train_panels.push_back(tpanel);
+ tpanel->set_visible(true);
+
+ new_trains.push_back(&train);
+}
+
+void Engineer::sighandler(int sig)
+{
+ if(sig==SIGSEGV || sig==SIGILL || sig==SIGFPE || sig==SIGABRT)
+ {
+ signal(sig, SIG_DFL);
+ IO::print(IO::cerr, "Fatal signal received, terminating\n");
+ const map<unsigned, Locomotive *> &locos = control.get_locomotives();
+ for(map<unsigned, Locomotive *>::const_iterator i=locos.begin(); i!=locos.end(); ++i)
+ i->second->set_speed(0);
+ control.flush();
+ raise(sig);
+ }
+ else if(sig==SIGTERM || sig==SIGINT)
+ exit(0);
}
Application::RegApp<Engineer> Engineer::reg;