X-Git-Url: http://git.tdb.fi/?a=blobdiff_plain;f=source%2Flibr2c2%2Ftracktype.cpp;h=6b16c553809dc7941a9523aac7889ee34f8a4f34;hb=11c68656ac53318801dcb36078509a07ae2c2a94;hp=fbed4c1d8d6020b9b19ed4c234b1c002d43f8b64;hpb=7a36d396eded897c421424905b2c938d770df341;p=r2c2.git

diff --git a/source/libr2c2/tracktype.cpp b/source/libr2c2/tracktype.cpp
index fbed4c1..6b16c55 100644
--- a/source/libr2c2/tracktype.cpp
+++ b/source/libr2c2/tracktype.cpp
@@ -1,4 +1,7 @@
 #include <cmath>
+#include <msp/datafile/collection.h>
+#include <msp/geometry/union.h>
+#include "trackappearance.h"
 #include "tracktype.h"
 
 using namespace std;
@@ -8,10 +11,23 @@ namespace R2C2 {
 
 TrackType::TrackType(const ArticleNumber &an):
 	ObjectType(an),
+	appearance(0),
 	state_bits(0),
 	autofit_preference(1)
 { }
 
+const TrackAppearance &TrackType::get_appearance() const
+{
+	if(!appearance)
+		throw logic_error("no appearance");
+	return *appearance;
+}
+
+float TrackType::get_gauge() const
+{
+	return get_appearance().get_gauge();
+}
+
 float TrackType::get_total_length() const
 {
 	return get_path_length(-1);
@@ -42,6 +58,36 @@ unsigned TrackType::get_n_paths() const
 	return n;
 }
 
+unsigned TrackType::coerce_path(unsigned entry, unsigned path) const
+{
+	const Endpoint &ep = get_endpoint(entry);
+	if(ep.has_path(path))
+		return path;
+
+	unsigned paths = get_paths();
+	if(paths>>(1<<state_bits))
+	{
+		/* There are more paths than can be expressed with state_bits, so
+		multiple paths are set at once.  See if one of the alternatives fits. */
+		unsigned step = 1<<state_bits;
+		for(unsigned p=path+step; paths>>p; p+=step)
+			if(ep.has_path(p))
+				return p;
+	}
+
+	// Find an endpoint that's connected to the entry and has the requested path
+	for(vector<Endpoint>::const_iterator i=endpoints.begin(); i!=endpoints.end(); ++i)
+		if(i->has_path(path) && i->has_common_paths(ep))
+		{
+			unsigned p = 1;
+			for(unsigned m=i->paths&ep.paths; m>>p; ++p) ;
+			return p-1;
+		}
+
+	// TODO crossings fall here
+	throw logic_error("TrackType::coerce_path");
+}
+
 bool TrackType::is_turnout() const
 {
 	return endpoints.size()>2;
@@ -60,7 +106,7 @@ const TrackType::Endpoint &TrackType::get_endpoint(unsigned i) const
 	return endpoints[i];
 }
 
-TrackPoint TrackType::get_point(unsigned epi, unsigned path, float d) const
+OrientedPoint TrackType::get_point(unsigned epi, unsigned path, float d) const
 {
 	if(epi>=endpoints.size())
 		throw out_of_range("TrackType::get_point");
@@ -75,8 +121,8 @@ TrackPoint TrackType::get_point(unsigned epi, unsigned path, float d) const
 		unsigned n_part_eps = (i->is_dead_end() ? 1 : 2);
 		for(unsigned j=0; j<n_part_eps; ++j)
 		{
-			TrackPoint p = i->get_point(j ? i->get_length() : 0);
-			Vector span = p.pos-endpoints[epi].pos;
+			OrientedPoint p = i->get_point(j ? i->get_length() : 0);
+			Vector span = p.position-endpoints[epi].pos;
 			if(dot(span, span)<1e-6)
 			{
 				part = &*i;
@@ -95,9 +141,9 @@ TrackPoint TrackType::get_point(unsigned epi, unsigned path, float d) const
 		{
 			if(part_ep==1)
 				d = plen-d;
-			TrackPoint p = part->get_point(d);
+			OrientedPoint p = part->get_point(d);
 			if(part_ep==1)
-				p.dir += Angle::half_turn();
+				p.rotation += Angle::half_turn();
 			return p;
 		}
 		else
@@ -112,15 +158,15 @@ TrackPoint TrackType::get_point(unsigned epi, unsigned path, float d) const
 	}
 }
 
-TrackPoint TrackType::get_nearest_point(const Vector &p) const
+OrientedPoint TrackType::get_nearest_point(const Vector &p) const
 {
-	TrackPoint result;
+	OrientedPoint result;
 	float dist = -1;
 
 	for(vector<TrackPart>::const_iterator i=parts.begin(); i!=parts.end(); ++i)
 	{
-		TrackPoint n = i->get_nearest_point(p);
-		float d = distance(n.pos, p);
+		OrientedPoint n = i->get_nearest_point(p);
+		float d = distance(n.position, p);
 		if(d<dist || dist<0)
 		{
 			result = n;
@@ -131,15 +177,6 @@ TrackPoint TrackType::get_nearest_point(const Vector &p) const
 	return result;
 }
 
-bool TrackType::collide_ray(const Vector &start, const Vector &dir, float width) const
-{
-	for(vector<TrackPart>::const_iterator i=parts.begin(); i!=parts.end(); ++i)
-		if(i->collide_ray(start, dir, width))
-			return true;
-
-	return false;
-}
-
 void TrackType::collect_endpoints()
 {
 	endpoints.clear();
@@ -153,16 +190,16 @@ void TrackType::collect_endpoints()
 		for(unsigned j=0; j<n_part_eps; ++j)
 			if(!i->get_link(j))
 			{
-				TrackPoint p = i->get_point(j ? i->get_length() : 0);
+				OrientedPoint p = i->get_point(j ? i->get_length() : 0);
 				if(j==0)
-					p.dir += Angle::half_turn();
+					p.rotation += Angle::half_turn();
 
 				bool found = false;
 				for(vector<Endpoint>::iterator k=endpoints.begin(); k!=endpoints.end(); ++k)
 				{
-					Vector d = k->pos-p.pos;
+					Vector d = k->pos-p.position;
 
-					Angle da = wrap_balanced(k->dir-p.dir);
+					Angle da = wrap_balanced(k->dir-p.rotation);
 
 					if(dot(d, d)<1e-6 && abs(da).radians()<0.01)
 					{
@@ -173,7 +210,7 @@ void TrackType::collect_endpoints()
 				}
 
 				if(!found)
-					endpoints.push_back(Endpoint(p.pos.x, p.pos.y, p.dir, 1<<i->get_path()));
+					endpoints.push_back(Endpoint(p.position.x, p.position.y, p.rotation, 1<<i->get_path()));
 			}
 	}
 }
@@ -185,10 +222,12 @@ TrackType::Endpoint::Endpoint(float x, float y, const Angle &d, unsigned p):
 { }
 
 
-TrackType::Loader::Loader(TrackType &t):
+TrackType::Loader::Loader(TrackType &t, Collection &c):
 	DataFile::DerivedObjectLoader<TrackType, ObjectType::Loader>(t),
+	coll(c),
 	state_bits_set(false)
 {
+	add("appearance",  &TrackType::appearance);
 	add("autofit_preference", &TrackType::autofit_preference);
 	add("object",      &TrackType::object);
 	add("state_bits",  &Loader::state_bits);
@@ -198,6 +237,13 @@ TrackType::Loader::Loader(TrackType &t):
 void TrackType::Loader::finish()
 {
 	obj.collect_endpoints();
+	vector<const Shape *> shapes;
+	for(vector<TrackPart>::iterator i=obj.parts.begin(); i!=obj.parts.end(); ++i)
+	{
+		i->create_shape();
+		shapes.push_back(&i->get_shape());
+	}
+	obj.shape = Geometry::Union<float, 3>::from_iterator_range(shapes.begin(), shapes.end()).clone();
 }
 
 void TrackType::Loader::part()