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_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");
layout.get_driver().set_turnout(turnout_id, 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_position");
const TrackType::Endpoint &ep = eps[epi];
{
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];
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];
}
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);
Track::Loader::Loader(Track &t):
- DataFile::BasicLoader<Track>(t)
+ DataFile::ObjectLoader<Track>(t)
{
add("position", &Loader::position);
add("rotation", &Track::rot);