start to work on LinearFrictionConeWrenchConstraint