Restructured SRF02 and Interrupt