A Charge Readout Algorithm for Piezoelectric Force Transducers