Basic penetration and contract normals system works