Add reset function

Resets all registers to factory defaults.