diff --git a/src/vel_spline.cpp b/src/vel_spline.cpp
index 1f91e56c709d1e6425ab8bf92deb63f875dabcc8..76d833c78afa5a2a8b5cb62b7ba8b544aab78531 100644
--- a/src/vel_spline.cpp
+++ b/src/vel_spline.cpp
@@ -181,7 +181,10 @@ bool CVelSpline::generate_max_length(double &max_len)
   if(fabs(this->start_acc-this->end_acc)<0.001)
   {
     if(fabs(this->end_vel-this->start_vel)<0.001)
+    {
       this->generate_constant_vel(this->start_vel,max_len);
+      return true;
+    }
     else
     {
       this->time=(2.0*max_len)/(this->end_vel+this->start_vel);