Modeling and Simulation of Nanorobotic Manipulation with an AFM probe