Create snapToMesh.py

First test of snap to mesh constrain