Added first steps for six-axis constraints