source/3d/track.cpp

   1 #include <cmath>
   2 #include <msp/gl/matrix.h>
   3 #include <msp/gl/renderer.h>
   4 #include "libr2c2/tracktype.h"
   5 #include "endpoint.h"
   6 #include "layout.h"
   7 #include "path.h"
   8 #include "track.h"
   9 #include "tracktype.h"
  10
  11 using namespace std;
  12 using namespace Msp;
  13
  14 namespace R2C2 {
  15
  16 Track3D::Track3D(Layout3D &l, Track &t):
  17         GL::ObjectInstance(l.get_catalogue().get_track(t.get_type()).get_object()),
  18         layout(l),
  19         track(t),
  20         type(layout.get_catalogue().get_track(track.get_type())),
  21         path(new Path3D(*this))
  22 {
  23         layout.add_track(*this);
  24         layout.get_scene().add(*this);
  25
  26         const vector<TrackType::Endpoint> &type_eps = track.get_type().get_endpoints();
  27         const vector<Track *> &links = track.get_links();
  28         for(unsigned i=0; i<type_eps.size(); ++i)
  29         {
  30                 if(!links[i] || links[i]>&track)
  31                         endpoints.push_back(new Endpoint3D(*this, i));
  32                 else
  33                         endpoints.push_back(0);
  34         }
  35
  36         track.signal_link_changed.connect(sigc::mem_fun(this, &Track3D::link_changed));
  37 }
  38
  39 Track3D::~Track3D()
  40 {
  41         delete path;
  42
  43         layout.remove_track(*this);
  44         layout.get_scene().remove(*this);
  45
  46         for(vector<Endpoint3D *>::iterator i=endpoints.begin(); i!=endpoints.end(); ++i)
  47                 delete *i;
  48 }
  49
  50 void Track3D::get_bounds(float angle, Vector &minp, Vector &maxp) const
  51 {
  52         type.get_bounds(angle-track.get_rotation(), minp, maxp);
  53
  54         float c = cos(-angle);
  55         float s = sin(-angle);
  56
  57         const Vector &pos = track.get_position();
  58         minp.x += c*pos.x-s*pos.y;
  59         maxp.x += c*pos.x-s*pos.y;
  60         minp.y += s*pos.x+c*pos.y;
  61         maxp.y += s*pos.x+c*pos.y;
  62         minp.z += pos.z;
  63         maxp.z += pos.z;
  64
  65         float slope = track.get_slope();
  66         if(slope>0)
  67                 maxp.z += slope;
  68         else
  69                 minp.z += slope;
  70 }
  71
  72 Vector Track3D::get_node() const
  73 {
  74         const Vector &pos = track.get_position();
  75         Vector minp;
  76         Vector maxp;
  77         type.get_bounds(0, minp, maxp);
  78         float rot = track.get_rotation();
  79         float c = cos(rot);
  80         float s = sin(rot);
  81
  82         Vector center((minp.x+maxp.x)/2, (minp.y+maxp.y)/2, 0);
  83         return Vector(pos.x+c*center.x-s*center.y, pos.y+s*center.x+c*center.y, pos.z+0.02);
  84 }
  85
  86 GL::Matrix Track3D::create_matrix() const
  87 {
  88         const Vector &pos = track.get_position();
  89         float rot = track.get_rotation();
  90
  91         GL::Matrix matrix;
  92         matrix.translate(pos.x, pos.y, pos.z);
  93         matrix.rotate(rot, 0, 0, 1);
  94         matrix.rotate(track.get_slope()/track.get_type().get_total_length(), 0, -1, 0);
  95
  96         return matrix;
  97 }
  98
  99 void Track3D::setup_render(Msp::GL::Renderer &renderer, const GL::Tag &) const
 100 {
 101         renderer.matrix_stack() *= create_matrix();
 102 }
 103
 104 void Track3D::link_changed(unsigned i, Track *trk)
 105 {
 106         if(!trk || trk>&track)
 107         {
 108                 if(!endpoints[i])
 109                         endpoints[i] = new Endpoint3D(*this, i);
 110         }
 111         else if(endpoints[i])
 112         {
 113                 delete endpoints[i];
 114                 endpoints[i] = 0;
 115         }
 116 }
 117
 118 } // namespace R2C2