Have switchMode() handle reset and restarts, and use switchMode() instead of calling function to switch specifically to EM