【求助】ATmega128操作HC_SR04超声波测距

chenwh_amdz

1. 
   
2. int   main(void)
   
3. {
   
4.        volatile unsigned int time_us=0;//定时器计数值
   
5.        volatile unsigned int distance_cm = 0; //距离
   
6. 
   
7.         DDRG |= 0x01;
   
8.         DDRG &= 0xfd; //Trig输出接PG0  Echo输入接PG1
   
9.         PORTG &= 0xfe; //PG0 = 0
   
10.         PORTG |= 0x02; //PG1 = 1 带上拉电阻输入
    
11. 
    
12.         lcd_init();     //液晶初始化
    
13. 
    
14.         while(1)
    
15.         {
    
16.                 PORTG &= 0xfe; //PG0 = 0
    
17.                 PORTG |= 0x01; //PG0 = 1
    
18.                 _delay_us(20);
    
19.                 PORTG &= 0xfe; //PG0 = 0
    
20. 
    
21.                 while(!(PING & 0x02)); //等待PG1=1
    
22.                 TCNT1 = 0; //开始一次计数               
    
23.                 TCCR1B = 0x02; //8分频
    
24.                
    
25.                 while(PING & 0x02); //等待PG1=0
    
26.                 TCCR1B = 0x00; //定时器停止
    
27.                 time_us = TCNT1; //读取计数值       
    
28. 
    
29.                 distance_cm = time_us/58;
    
30. 
    
31.                 table[0] = (distance_cm%1000)/100 + 0x30;
    
32.                 table[1] = (distance_cm%100)/10 + 0x30;
    
33.                 table[2] = distance_cm%10 + 0x30;
    
34. 
    
35.                 lcd_display(table);
    
36. 
    
37.                 _delay_ms(100);
    
38. 
    
39.         }
    
40. }

复制代码

单片机使用8M晶振，测试结果在0-5cm内显示正确，而超过5cm后液晶一直显示是5cm，请问程序有什么问题吗？