X-Git-Url: http://git.tdb.fi/?a=blobdiff_plain;f=source%2Flibr2c2%2Fobject.cpp;h=d7c7db25e68beaeac81923f5eb2e6258b10e2e7d;hb=4529bf980cf3558d86c07266de7d890d3f5e06a6;hp=1b48a862ae6b634c499fa49c094e54bc5c41cb05;hpb=b88d3630a0e3fdd763db018bbe5dbfe3180a95f2;p=r2c2.git

diff --git a/source/libr2c2/object.cpp b/source/libr2c2/object.cpp
index 1b48a86..d7c7db2 100644
--- a/source/libr2c2/object.cpp
+++ b/source/libr2c2/object.cpp
@@ -18,8 +18,8 @@ bool Object::snap(Snap &sn, float limit, SnapType what) const
 		for(unsigned i=0; i<nsn; ++i)
 		{
 			Snap node = get_snap_node(i);
-			Vector d(sn.position.x-node.position.x, sn.position.y-node.position.y, sn.position.z-node.position.z);
-			if(d.x*d.x+d.y*d.y<limit*limit)
+			Vector span = sn.position-node.position;
+			if(dot(span, span)<limit*limit)
 			{
 				sn = node;
 				return true;
@@ -45,11 +45,15 @@ bool Object::snap_to(const Object &other, float limit, SnapType what)
 		Snap ssn = sn;
 		if(other.snap(ssn, limit, what))
 		{
-			set_rotation(rotation+ssn.rotation-sn.rotation-M_PI);
+			if(what==SNAP_NODE)
+				set_rotation(rotation+ssn.rotation-sn.rotation-Angle::half_turn());
+			else
+			{
+				Angle adiff = wrap_balanced((ssn.rotation-sn.rotation)*2.0f)/2.0f;
+				set_rotation(rotation+adiff);
+			}
 			sn = get_snap_node(i);
-			position.x += ssn.position.x-sn.position.x;
-			position.y += ssn.position.y-sn.position.y;
-			position.z += ssn.position.z-sn.position.z;
+			set_position(position+ssn.position-sn.position);
 			return true;
 		}
 	}
@@ -57,4 +61,48 @@ bool Object::snap_to(const Object &other, float limit, SnapType what)
 	return false;
 }
 
+Object *Object::get_link(unsigned) const
+{
+	throw out_of_range("Object::get_link");
+}
+
+bool Object::break_link(Object &other)
+{
+	unsigned nls = get_n_link_slots();
+	for(unsigned i=0; i<nls; ++i)
+		if(get_link(i)==&other)
+			return break_link(i);
+
+	return false;
+}
+
+void Object::break_links()
+{
+	unsigned nls = get_n_link_slots();
+	for(unsigned i=0; i<nls; ++i)
+		break_link(i);
+}
+
+bool Object::collide_ray(const Ray &ray) const
+{
+	const Shape *shape = get_type().get_shape();
+	if(!shape)
+		return false;
+
+	Transform reverse_trans = Transform::rotation(rotation, Vector(0, 0, -1))*
+		Transform::translation(-position);
+	return shape->check_intersection(reverse_trans.transform(ray));
+}
+
+BoundingBox Object::get_bounding_box() const
+{
+	const Shape *shape = get_type().get_shape();
+	if(!shape)
+		return BoundingBox();
+
+	Transform trans = Transform::translation(position)*
+		Transform::rotation(rotation, Vector(0, 0, 1));
+	return trans.transform(shape->get_axis_aligned_bounding_box());
+}
+
 } // namespace R2C2