Moved bcm2835_st_read function from .S to .h file