兩顆超音波等距的問題

比利

請問各位大大
小弟想讓兩顆超音波的距離相等時執行其他成程式
判斷式要怎麼寫呢

小弟的想法是
if(dis1>dis2){
        forward();
}

else if(dis1<dis2){
        backward();
}

else{
STOP();
}

超音波500ms偵測一次

       

超新手

這樣ok.有什麼問題嗎？