diff --git a/source/RobotAPI/libraries/core/Trajectory.cpp b/source/RobotAPI/libraries/core/Trajectory.cpp
index 1c75dcd1cf70470595a5f2f0f242e1106c287229..a1bb8fe9b2c75cfb479d1290256a9e70e1793f4a 100644
--- a/source/RobotAPI/libraries/core/Trajectory.cpp
+++ b/source/RobotAPI/libraries/core/Trajectory.cpp
@@ -1668,7 +1668,7 @@ namespace armarx
         }
 
         Ice::DoubleSeq result;
-        size_t size = int((endTime - startTime) / stepSize) + 1;
+        size_t size = std::round((endTime - startTime) / stepSize) + 1;
         stepSize = (endTime - startTime) / (size - 1);
         result.reserve(size);