Version Using bcm2835 library

Take care, to be tested