A system and method to optimize the material removal rate of a tool in a safe and geometrically precise manner, to facilitate the application of smooth contact forces and to sense tool contact forces for rapidly providing power regulation safeguards against tool inadvertently intruding into forbidden regions, for verifying and correlating physically extracted material against the virtual model, and for detecting and mitigating drill walking.