A method of operating a MEMS device includes generating a MEMS drive signal, and generating and modifying the MEMS drive signal based upon a control signal to produce a modified drive signal. The method further includes generating the control signal by determining when a feedback signal from the MEMS device is at its peak value, comparing the peak value to a desired value when the feedback signal is as its peak, and generating the control signal depending upon whether the peak value is at least equal to a desired value. The modification of the MEMS drive signal based upon the control signal to produce the modified drive signal includes skipping generation of a next pulse of the modified drive signal when the control signal indicates the peak value is at least equal to the desired value.