Mods to Test1 for testing

Al outputs that go to the Mega set low. Corrected one output.
Add initialization of CHARGER_SEL_HIGH_CURRENT

Plus other misc cosmetic cleanup
Initalize CHARGER_SEL_HIGH_CURRENT output

Missed in the previous commit