Add simple contact function FEM.modifyPosCld