function 'bcm2835_gpio_fsel optimized