Using MSP430G2xxx to communicate with sonar