There are few steps to make AFM. 

• First make nanometer size tip ✅
• Power supply ✅
• Make it vibrate up and down
• Measure the force of vibration/input
• Coarse XYZ movement of sample
• Fine XYZ movement of AFM tip - electrical part ✅
• Fine XYZ movement of AFM tip - mechanical part 

(Probably there are more steps, we will uncover them as project continues)

XY movement has a very good explanation in Lego2Nano with electric schematic and software algorithms. 

For force measure we will use Quartz fork instead of laser one.