Incorrect logging output
gonzalocasas opened this issue · comments
The joint_trajectory_streamer outputs an off-by-one debugging line when sending points to the controller, where it says "Point[%d of %d] sent to controller" and it uses 0-based indexing for the first value, but size for the second value, e.g. a trajectory of 3 points will print the final point as "Point[2 of 3] sent to controller", which is misleading.
The bug is on this line, instead of the index of the current point, it should output index+1, or move the increment line above the output.