diff --git a/include/curves/bezier_curve.h b/include/curves/bezier_curve.h
index 4ed821ac7f89cd4cef83d17f4193e96e8c8f3c28..cb4c684a823acae22af968bce9d0c2a6e3d91dbf 100644
--- a/include/curves/bezier_curve.h
+++ b/include/curves/bezier_curve.h
@@ -334,7 +334,7 @@ struct bezier_curve : public curve_abc<Time, Numeric, Dim, Safe, Point>
         {
             return split(t2).first;
         }
-        if (fabs(t2-T_max_))
+        if (fabs(t2-T_max_)<MARGIN)
         {
             return split(t1).second;
         }