-/* $Id$
-
-This file is part of R²C²
-Copyright © 2006-2010 Mikkosoft Productions, Mikko Rasa
-Distributed under the GPL
-*/
-
#include <cmath>
#include "block.h"
#include "catalogue.h"
namespace R2C2 {
Track::Track(Layout &l, const TrackType &t):
- layout(l),
+ Object(l),
type(t),
block(0),
- rot(0),
slope(0),
flex(false),
turnout_id(0),
sensor_id(0),
links(type.get_endpoints().size()),
- active_path(0)
+ active_path(0),
+ path_changing(false)
{
if(type.is_turnout())
turnout_id = layout.allocate_turnout_id();
layout.remove_track(*this);
}
+Track *Track::clone(Layout *to_layout) const
+{
+ Track *track = new Track((to_layout ? *to_layout : layout), type);
+ track->set_position(position);
+ track->set_rotation(rotation);
+ return track;
+}
+
void Track::set_block(Block *b)
{
if(b && !b->has_track(*this))
- throw InvalidParameterValue("Track is not in the Block");
+ throw logic_error("track not in block");
if(!b && block && block->has_track(*this))
- throw InvalidState("Track is still in a Block");
+ throw logic_error("track still in block");
block = b;
}
Block &Track::get_block() const
{
if(!block)
- throw InvalidState("No Block");
+ throw logic_error("!block");
return *block;
}
-void Track::set_position(const Point &p)
+void Track::set_position(const Vector &p)
{
- pos = p;
+ position = p;
}
void Track::set_rotation(float r)
{
- rot = r;
- while(rot<0)
- rot += M_PI*2;
- while(rot>M_PI*2)
- rot -= M_PI*2;
+ rotation = r;
+ while(rotation<0)
+ rotation += M_PI*2;
+ while(rotation>M_PI*2)
+ rotation -= M_PI*2;
}
void Track::set_slope(float s)
if(links[0] && links[1])
{
- Point epp0 = links[0]->get_endpoint_position(links[0]->get_endpoint_by_link(*this));
- Point epp1 = links[1]->get_endpoint_position(links[1]->get_endpoint_by_link(*this));
- pos.z = epp0.z;
- slope = epp1.z-pos.z;
+ Vector epp0 = links[0]->get_endpoint_position(links[0]->get_endpoint_by_link(*this));
+ Vector epp1 = links[1]->get_endpoint_position(links[1]->get_endpoint_by_link(*this));
+ position.z = epp0.z;
+ slope = epp1.z-position.z;
}
else
{
slope = 0;
if(links[0])
{
- Point epp = links[0]->get_endpoint_position(links[0]->get_endpoint_by_link(*this));
- pos.z = epp.z;
+ Vector epp = links[0]->get_endpoint_position(links[0]->get_endpoint_by_link(*this));
+ position.z = epp.z;
}
else if(links[1])
{
- Point epp = links[1]->get_endpoint_position(links[1]->get_endpoint_by_link(*this));
- pos.z = epp.z;
+ Vector epp = links[1]->get_endpoint_position(links[1]->get_endpoint_by_link(*this));
+ position.z = epp.z;
}
}
}
void Track::set_turnout_id(unsigned i)
{
if(!type.is_turnout())
- throw InvalidState("Not a turnout");
+ throw logic_error("not a turnout");
turnout_id = i;
layout.create_blocks(*this);
void Track::set_sensor_id(unsigned i)
{
if(type.is_turnout())
- throw InvalidState("Can't set sensor on a turnout");
+ throw logic_error("is a turnout");
sensor_id = i;
layout.create_blocks(*this);
void Track::set_active_path(unsigned p)
{
if(!turnout_id)
- throw InvalidState("Not a turnout");
+ throw logic_error("not a turnout");
if(!(type.get_paths()&(1<<p)))
- throw InvalidParameterValue("Invalid path");
+ throw invalid_argument("Track::set_active_path");
+ path_changing = true;
layout.get_driver().set_turnout(turnout_id, p);
}
return -1;
}
-Point Track::get_endpoint_position(unsigned epi) const
+Vector Track::get_endpoint_position(unsigned epi) const
{
const vector<TrackType::Endpoint> &eps = type.get_endpoints();
if(epi>=eps.size())
- throw InvalidParameterValue("TrackType::Endpoint index out of range");
+ throw out_of_range("Track::get_endpoint_position");
const TrackType::Endpoint &ep = eps[epi];
- float c = cos(rot);
- float s = sin(rot);
+ float c = cos(rotation);
+ float s = sin(rotation);
- Point p(pos.x+c*ep.pos.x-s*ep.pos.y, pos.y+s*ep.pos.x+c*ep.pos.y, pos.z);
+ Vector p(position.x+c*ep.pos.x-s*ep.pos.y, position.y+s*ep.pos.x+c*ep.pos.y, position.z);
if(eps.size()==2 && epi==1)
p.z += slope;
return p;
{
const vector<TrackType::Endpoint> &eps = type.get_endpoints();
if(epi>=eps.size())
- throw InvalidParameterValue("TrackType::Endpoint index out of range");
+ throw out_of_range("Track::get_endpoint_direction");
const TrackType::Endpoint &ep = eps[epi];
- return rot+ep.dir;
+ return rotation+ep.dir;
}
bool Track::snap_to(Track &other, bool link, float limit)
for(unsigned i=0; i<eps.size(); ++i)
{
- Point epp = get_endpoint_position(i);
+ Vector epp = get_endpoint_position(i);
for(unsigned j=0; j<other_eps.size(); ++j)
{
if(other.get_link(j))
continue;
- Point epp2 = other.get_endpoint_position(j);
+ Vector epp2 = other.get_endpoint_position(j);
float dx = epp2.x-epp.x;
float dy = epp2.y-epp.y;
float dz = epp2.z-epp.z;
{
if(!link || (!flex && !other.get_flex()))
{
- set_rotation(other.rot+other_eps[j].dir-eps[i].dir+M_PI);
- Point p(epp2.x-(eps[i].pos.x*cos(rot)-eps[i].pos.y*sin(rot)),
- epp2.y-(eps[i].pos.y*cos(rot)+eps[i].pos.x*sin(rot)),
+ set_rotation(other.rotation+other_eps[j].dir-eps[i].dir+M_PI);
+ Vector p(epp2.x-(eps[i].pos.x*cos(rotation)-eps[i].pos.y*sin(rotation)),
+ epp2.y-(eps[i].pos.y*cos(rotation)+eps[i].pos.x*sin(rotation)),
epp2.z);
if(eps.size()==2 && i==1)
p.z -= slope;
links[i] = &other;
other.links[j] = this;
layout.create_blocks(*this);
+
+ signal_link_changed.emit(i, &other);
+ other.signal_link_changed.emit(j, this);
}
return true;
return false;
}
-bool Track::snap(Point &pt, float &d) const
+bool Track::snap(Vector &pt, float &d) const
{
const vector<TrackType::Endpoint> &eps = type.get_endpoints();
for(unsigned i=0; i<eps.size(); ++i)
{
- Point epp = get_endpoint_position(i);
+ Vector epp = get_endpoint_position(i);
float dx = pt.x-epp.x;
float dy = pt.y-epp.y;
if(dx*dx+dy*dy<1e-4)
{
pt = epp;
- d = rot+eps[i].dir;
+ d = rotation+eps[i].dir;
return true;
}
}
trk.break_link(*this);
// XXX Creates the blocks twice
layout.create_blocks(*this);
+ signal_link_changed.emit(i-links.begin(), 0);
return;
}
}
Track *Track::get_link(unsigned i) const
{
- if(i>links.size())
- throw InvalidParameterValue("Link index out of range");
+ if(i>=links.size())
+ throw out_of_range("Track::get_link");
return links[i];
}
TrackPoint Track::get_point(unsigned epi, unsigned path, float d) const
{
TrackPoint p = type.get_point(epi, path, d);
- float c = cos(rot);
- float s = sin(rot);
+ float c = cos(rotation);
+ float s = sin(rotation);
- p.pos = Point(pos.x+c*p.pos.x-s*p.pos.y, pos.y+s*p.pos.x+c*p.pos.y, pos.z);
- p.dir += rot;
+ p.pos = Vector(position.x+c*p.pos.x-s*p.pos.y, position.y+s*p.pos.x+c*p.pos.y, position.z);
+ p.dir += rotation;
if(type.get_endpoints().size()==2)
{
float len = type.get_path_length(path);
return get_point(epi, active_path, d);
}
+TrackPoint Track::get_nearest_point(const Vector &p) const
+{
+ Vector local(p.x-position.x, p.y-position.y, p.z-position.z);
+ float c = cos(rotation);
+ float s = sin(rotation);
+ local = Vector(c*local.x+s*local.y, c*local.y-s*local.x, local.z);
+
+ TrackPoint tp = type.get_nearest_point(local);
+ tp.pos = Vector(position.x+tp.pos.x*c-tp.pos.y*s, position.y+tp.pos.y*c+tp.pos.x*s, position.z+tp.pos.z);
+ tp.dir += rotation;
+ return tp;
+}
+
+bool Track::collide_ray(const Vector &start, const Vector &ray) const
+{
+ Vector local_start(start.x-position.x, start.y-position.y, start.z-position.z);
+ float c = cos(rotation);
+ float s = sin(rotation);
+ local_start = Vector(c*local_start.x+s*local_start.y, c*local_start.y-s*local_start.x, local_start.z);
+ Vector local_ray(c*ray.x+s*ray.y, c*ray.y-s*ray.x, ray.z);
+
+ float width = layout.get_catalogue().get_ballast_profile().get_width();
+
+ return type.collide_ray(local_start, local_ray, width);
+}
+
void Track::save(list<DataFile::Statement> &st) const
{
- st.push_back((DataFile::Statement("position"), pos.x, pos.y, pos.z));
- st.push_back((DataFile::Statement("rotation"), rot));
+ st.push_back((DataFile::Statement("position"), position.x, position.y, position.z));
+ st.push_back((DataFile::Statement("rotation"), rotation));
st.push_back((DataFile::Statement("slope"), slope));
if(turnout_id)
st.push_back((DataFile::Statement("turnout_id"), turnout_id));
if(addr==turnout_id)
{
active_path = state;
+ path_changing = false;
signal_path_changed.emit(active_path);
}
}
Track::Loader::Loader(Track &t):
- DataFile::BasicLoader<Track>(t)
+ DataFile::ObjectLoader<Track>(t)
{
add("position", &Loader::position);
- add("rotation", &Track::rot);
+ add("rotation", &Loader::rotation);
add("slope", &Track::slope);
add("turnout_id", &Loader::turnout_id);
add("sensor_id", &Loader::sensor_id);
void Track::Loader::position(float x, float y, float z)
{
- obj.pos = Point(x, y, z);
+ obj.position = Vector(x, y, z);
+}
+
+void Track::Loader::rotation(float r)
+{
+ obj.rotation = r;
}
void Track::Loader::sensor_id(unsigned id)
projects / r2c2.git / blobdiff