Look at main branch,
src/curobo/rollout/arm_reacher.py Line 373: assigned current_fn.forward_out_distance returns to [pose_err, pos_err, quat_err]
src/curobo/rollout/cost/pose_cost.py Line 430: function forward_out_distance return in [cost, r_err, g_dist] order.
Shouldn't arm_reacher.py Line 373 be [pose_err, quat_err, pos_err]?
Thanks for help