3D Mapping for PVI- Geometry, Image Integration and Incorporation of Contact Force Into Work Flow