Add reset to bootloader function, for testing