A MEMS piezoelectric sensor comprises a plurality of capacitors some of which may be used for sensing and others used for feedback. The capacitors may be switched to connect or disconnect selected capacitors from the sensor. Embodiments convert a two port sensor into a four port sensor without significant changes in hardware design and improve SNR and correct for offset and out-of-axis errors due to process mismatch and variations.