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();
if(!(type.get_paths()&(1<<p)))
throw invalid_argument("Track::set_active_path");
+ path_changing = true;
layout.get_driver().set_turnout(turnout_id, p);
}
Track *Track::get_link(unsigned i) const
{
- if(i>links.size())
+ if(i>=links.size())
throw out_of_range("Track::get_link");
return links[i];
return get_point(epi, active_path, d);
}
+TrackPoint Track::get_nearest_point(const Vector &p) const
+{
+ Vector local(p.x-pos.x, p.y-pos.y, p.z-pos.z);
+ float c = cos(rot);
+ float s = sin(rot);
+ 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(pos.x+tp.pos.x*c-tp.pos.y*s, pos.y+tp.pos.y*c+tp.pos.x*s, pos.z+tp.pos.z);
+ tp.dir += rot;
+ return tp;
+}
+
bool Track::collide_ray(const Vector &start, const Vector &ray)
{
Vector local_start(start.x-pos.x, start.y-pos.y, start.z-pos.z);
if(addr==turnout_id)
{
active_path = state;
+ path_changing = false;
signal_path_changed.emit(active_path);
}
}