drivers/bcm2835gpio: Fully restore GPIOs after use