Fix a missed NonlinearConstraint
Add feet collision_filter_group to atlas_min_con