Fix the normalizations constants in planning and make use_collision_cost an argument to compute_trans_traj