Limit Z difference when linking tracks

[r2c2.git] / source / libmarklin / track.cpp

diff --git a/source/libmarklin/track.cpp b/source/libmarklin/track.cpp
index 0a9f1ac83f8977f02935fd6f5838d93265a62278..6ec1c6c8b295e3d6ff39a1b9446abcca8c96b99f 100644 (file)
--- a/source/libmarklin/track.cpp
+++ b/source/libmarklin/track.cpp
@@ -212,7 +212,8 @@ bool Track::snap_to(Track &other, bool link)
                        Point epp2 = other.get_endpoint_position(j);
                        float dx = epp2.x-epp.x;
                        float dy = epp2.y-epp.y;
-                       if(dx*dx+dy*dy<limit)
+                       float dz = epp2.z-epp.z;
+                       if(dx*dx+dy*dy<limit && dz*dz<4e-4)
                        {
                                if(!link || (!flex && !other.get_flex()))
                                {