added constraints self-collision and com pos