Improved battery voltage init, removed bogus printf() from debugging
Merged with upstream