Hi all, I noticed a strange loop in the queryStateService function, in joint_spline_trajectory_controller.cpp, for (size_t i = 0; i < q.size(); ++i) { } Is it really necessary or does it need to be cleaned up ? Guido