Mechanical AFM (implementation based on Hapala et al., Phys. Rev. B, 90:085421, 2014)