Robofun 機器人論壇

標題: ping超音波使用在avr上的問題 [打印本頁]

作者: tom7232 時間: 2011-11-9 01:48
標題: ping超音波使用在avr上的問題
我將ping超音波的信號角接至PORTB.3，程式如下
//////////////////////////////////////////////////////////////////////////////////////////////////////
#include <mega16.h>
#include <alcd.h>
#include <delay.h>
unsigned long dis_cal(unsigned int timer);
void lcd_scan(unsigned long distance);
unsigned char x=0;
unsigned int pwm_1=0,timer;
double distance;
interrupt [TIM0_OVF] void timer0_ovf_isr(void)
{
  if(TCCR0==0x07)                            //00000111(計時由T0腳位輸入，正緣觸發)
   {
      TCCR0=0x06;                         //令00000110(計時由T0腳位輸入，負緣觸發)
      timer=0;
      x=1;
   }
  else if(TCCR0==0x06)                         //00000110(計時由T0腳位輸入，負緣觸發)
   {
      TCCR0=0x07;                         //令00000111(計時由T0腳位輸入，正緣觸發)
      x=0;
   }
   TCNT0=0xff;                            //令初值255
}
interrupt [TIM1_OVF] void timer1_ovf_isr(void)
{
   TCNT1H=0xff;
   TCNT1L=0xD8;
   pwm_1++;
   if(x==1)
   {
   timer++;
   }
   PORTB.3=(!PORTB.3);
}
void main(void)
{
PORTB=0x08;
DDRB=0x00;
TCCR0=0x07;                               //00000111(計時由T0腳位輸入，正緣觸發)
TCNT0=0xff;                               //計時器0為256
TCCR1A=0x00;
TCCR1B=0x01;                               //00000001(無分頻)
TCNT1H=0x00;
TCNT1L=0x00;
TIMSK=0x05;
ACSR=0x80;
lcd_init(16);
#asm("sei")
while (1)
   {
   if(pwm_1>=0 && pwm_1<=500)
      {
      PINB.3=1;
      }
   else if(pwm_1>500 && pwm_1<=6000)
      {
      if(pwm_1>5000)
         {
            pwm_1=0;
         }
      else
         {
         PINB.3=0;
         distance=dis_cal(timer);
         lcd_scan(distance);
         }
      }
   }//end while
}//end main
unsigned long dis_cal(unsigned int timer)
{
   unsigned long distance;
   float handle;
   handle=((10*timer)/2)*2257;
   distance=handle;
   return distance;
}
void lcd_scan(unsigned long distance)
{
   lcd_clear();
   lcd_gotoxy(0,0);
   lcd_putsf("Test Distance:");
   lcd_gotoxy(0,1);
   lcd_putchar((distance/100%10)+0x30);
   lcd_gotoxy(1,1);
   lcd_putchar((distance/10%10)+0x30);
   lcd_gotoxy(2,1);
   lcd_putchar((distance%10)+0x30);
   lcd_gotoxy(3,1);
   lcd_putsf("cm");
}

//////////////////////////////////////////////////////
但程式結果出來所量測距離在LCD上是不會改變的，不知原因在哪??

作者: tom7232 時間: 2011-11-9 01:51
剛程式有點問題，這個才是。

#include <mega16.h>
#include <alcd.h>
#include <delay.h>
unsigned long dis_cal(unsigned int timer);
void lcd_scan(unsigned long distance);
unsigned char x=0;
unsigned int pwm_1=0,timer;
double distance;
interrupt [TIM0_OVF] void timer0_ovf_isr(void)
{
  if(TCCR0==0x07)                            //00000111(計時由T0腳位輸入，正緣觸發)
   {
      TCCR0=0x06;                         //令00000110(計時由T0腳位輸入，負緣觸發)
      timer=0;
      x=1;
   }
  else if(TCCR0==0x06)                         //00000110(計時由T0腳位輸入，負緣觸發)
   {
      TCCR0=0x07;                         //令00000111(計時由T0腳位輸入，正緣觸發)
      x=0;
   }
   TCNT0=0xff;                            //令初值255
}
interrupt [TIM1_OVF] void timer1_ovf_isr(void)
{
   TCNT1H=0xff;
   TCNT1L=0xD8;
   pwm_1++;
   if(x==1)
   {
   timer++;
   }
   PORTB.3=(!PORTB.3);
}
void main(void)
{
PORTB=0x08;
DDRB=0x00;
TCCR0=0x07;                               //00000111(計時由T0腳位輸入，正緣觸發)
TCNT0=0xff;                               //計時器0為256
TCCR1A=0x00;
TCCR1B=0x01;                               //00000001(無分頻)
TCNT1H=0x00;
TCNT1L=0x00;
TIMSK=0x05;
ACSR=0x80;
lcd_init(16);
#asm("sei")
while (1)
   {
   if(pwm_1>=0 && pwm_1<=500)
      {
      PINB.3=1;
      }
   else if(pwm_1>500 && pwm_1<=6000)
      {
      if(pwm_1>5000)
         {
            pwm_1=0;
         }
      else
         {
         PINB.3=0;
         distance=dis_cal(timer);
         lcd_scan(distance);
         }
      }
   }//end while
}//end main
unsigned long dis_cal(unsigned int timer)
{
   unsigned long distance;
   float handle;
   handle=(10*(float)timer)/58;
   distance=handle;
   return distance;
}
void lcd_scan(unsigned long distance)
{
   lcd_clear();
   lcd_gotoxy(0,0);
   lcd_putsf("Test Distance:");
   lcd_gotoxy(0,1);
   lcd_putchar((distance/100%10)+0x30);
   lcd_gotoxy(1,1);
   lcd_putchar((distance/10%10)+0x30);
   lcd_gotoxy(2,1);
   lcd_putchar((distance%10)+0x30);
   lcd_gotoxy(3,1);
   lcd_putsf("cm");
}

歡迎光臨 Robofun 機器人論壇 (https://robofun.net/forum/)