Restructured GPIO initializaton, tried to fix watchdog
GPIO init clean up, merging back