Z Axis Diving Into Workpiece during 3D Finishing Toolpath