求一份AY-SEB Kit中超声波模块的独立程序（用msp430f5529）

尝试过用msp430f5529中的电压比较器，把接收回来的波形经过比较器（与1.5v比较）之后小于1.5v拉低P2.0口，然后用定时器结算发送之后与P2.0被拉低的时间差。但是不成功。下面是代码（用计数器读取1ms延时—a的值就是间隔时间—正常），去掉‘ // ’的是超声波程序（读取失败了，a不改变延时就不会变）。求一份正确的程序

TA1CTL=TASSEL_1+MC_2;   //ACLK 连续计数模式    

 send_wave();

 delayms(1);

//     if(P2IN!=BIT0)   //如果2.0被拉低

//     {      

a=TA1R;                 //取出计数值      

a=a*1000.0/32768;       //计算时间      

delayms(10);                   //10ms后再发下一次40khz驱动信号

 //     }      

TA1CTL=MC_0+TACLR;     //计数停止并清零      

_nop();