Added GPIO setup to main