fix segmentVelocity computation problem for freeRobot