Add GPIO ports setup and controll
Adds GPIO ports and proper setup and reaction to battery levels