minor fix

source/armarx/navigation/local_planning/ros_conversions.cpp

@@ -96,7 +96,7 @@ namespace armarx::navigation::conv
         // TODO this timestamp should be given via the argument list
         DateTime timestamp = Clock::Now();
 
-        ARMARX_CHECK_EQUAL(tebPoses.size(), teb.timediffs().size()-1);
+        ARMARX_CHECK_EQUAL(tebPoses.size()-1, teb.timediffs().size());
 
         // add the first pose at this timestamp
         trajectory.push_back(core::LocalTrajectoryPoint{.timestamp = timestamp, .pose = {fromRos(tebPoses.front()->pose())}});