_functions.ino: Fix  softReset function