New repo for holonomic configuration constraints for motion planning