A modified Prandtl-Ishlinskii (PI) model, referred to as a direct inverse asymmetric PI (DIAPI) model in this paper, was implemented to reduce the displacement error between a predicted model and the actual trajectory of a piezoelectric actuator which is commonly found in AFM systems. Due to the nonlinearity of the piezoelectric actuator, the standard symmetric PI model cannot precisely describe the asymmetric motion of the actuator. In order to improve the accuracy of AFM scans, two series of slope parameters were introduced in the PI model to describe both the voltage-increase-loop (trace) and voltage-decrease-loop (retrace). A feedforward controller based on the DIAPI model was implemented to compensate hysteresis. Performance of the DIAPI model and the feedforward controller were validated by scanning micro-lenses and standard silicon grating using a custom-built AFM.