X-Git-Url: http://git.tdb.fi/?a=blobdiff_plain;f=source%2Flibr2c2%2Ftrackpart.cpp;h=71845bb73c2c22591d3f99b59aaf4d455b2d7988;hb=d0af7846e05691d65d8021e46c8f81e8ca05199a;hp=2b3809dd7809d1b31bdea92ca5ca6e73a83430d0;hpb=621c5c938d70ba0d155e0eda91a708db0a52c0dc;p=r2c2.git

diff --git a/source/libr2c2/trackpart.cpp b/source/libr2c2/trackpart.cpp
index 2b3809d..71845bb 100644
--- a/source/libr2c2/trackpart.cpp
+++ b/source/libr2c2/trackpart.cpp
@@ -48,6 +48,37 @@ TrackPoint TrackPart::get_point(float d) const
 	return result;
 }
 
+TrackPoint TrackPart::get_nearest_point(const Vector &p) const
+{
+	TrackPoint tp;
+	float c = cos(dir);
+	float s = sin(dir);
+	if(radius)
+	{
+		Vector v(p.x-pos.x+radius*s, p.y-pos.y-radius*c);
+		float a = atan2(v.y, v.x)+M_PI/2-dir;
+		if(radius<0)
+			a = M_PI-a;
+		while(a<length/2-M_PI)
+			a += M_PI*2;
+		while(a>length/2+M_PI)
+			a -= M_PI*2;
+		a = min(max(a, 0.0f), length);
+		if(radius<0)	
+			a = -a;
+		tp.pos = Vector(pos.x+radius*(sin(dir+a)-s), pos.y+radius*(c-cos(dir+a)));
+		tp.dir = dir+a;
+	}
+	else
+	{
+		Vector v(p.x-pos.x, p.y-pos.y);
+		float d = min(max(c*v.x+s*v.y, 0.0f), length);
+		tp.pos = Vector(pos.x+c*d, pos.y+s*d);
+		tp.dir = dir;
+	}
+	return tp;
+}
+
 void TrackPart::check_link(TrackPart &other)
 {
 	unsigned n_eps = (dead_end ? 1 : 2);
@@ -114,7 +145,7 @@ bool TrackPart::collide_ray(const Vector &start, const Vector &ray, float width)
 
 
 TrackPart::Loader::Loader(TrackPart &p):
-	Msp::DataFile::BasicLoader<TrackPart>(p)
+	Msp::DataFile::ObjectLoader<TrackPart>(p)
 {
 	add("start",    &Loader::start);
 	add("length",   &TrackPart::length);