Imroved GPIO function select w/ general set_bits funciton