added debug prints for disabling setSafetyEnabled and killing the watchdog in autonomous()