Od dłuższego czasu borykam się z problemem mierzenia odległości za pomocą hc-sr04.
Wysyłam sygnał na pin Trig, ktory jest generowany na porcie B (PB1), sygnał z echa odbieram za pomocą przerwania INT0, mierze czas pomiędzy zboczami rosnącymi i opadającymi i wyswietlam wynik na wyświetlaczu siedmiosegmentowym (podpiętym do portu A i C). Niestety na wyswietlaczu cały czas pojawia sie liczba 0. (Atmega32a, kwarc 8MHz).
Byłbym wdzięczny gdyby ktoś podpowiedział mi gdzie robię błąd.
Kod:
[syntax=c]#include <avr/io.h>
#include <util/delay.h>
#include <avr/interrupt.h>
#define SEG_1 (1<<PA3) // SEGMENT 1 (12)
#define SEG_2 (1<<PA2) // SEGMENT 2 (9)
#define SEG_3 (1<<PA1) // SEGMENT 3 (8)
#define SEG_4 (1<<PA0) // SEGMENT 4 (6)
#define PORT_SEG PORTA //PORT Z PODLACZONYM ZASILANIEM WYS LED
#define PORT_WYS PORTC // PORT DO STEROWANIA SEGMENTAMI
#define miganie _delay_us(300)
uint8_t cyfra_1, cyfra_2, cyfra_3, cyfra_4, na_wyswietlacz(uint8_t);
volatile unsigned int odleglosc,wynik,sygnal=40,flaga=0;
int przycisk(uint8_t);
int main()
{
DDRA=0XFF;
DDRC=0XFF;
DDRD=(1<<PD6)|(1<<PD7);
PORTD=(1<<PD5);
DDRB=0XFF;
TCCR0=(0<<WGM00)|(1<<WGM01)|(0<<CS00)|(1<<CS01)|(0<<CS02); //CTC, preskaler=8
TIMSK=(1<<OCIE0);
GICR=(1<<INT0);
MCUCR=(1<<ISC00)|(1<<ISC01);
sei();
while(1)
{
OCR0=2; // przerwanie co 2 us
wynik=wynik/29;
for(int i=0;wynik>=1000*i;i++)
cyfra_1=i;
for(int i=0;wynik-1000*cyfra_1>=100*i;i++)
cyfra_2=i;
for(int i=0;wynik-1000*cyfra_1-100*cyfra_2>=10*i;i++)
cyfra_3=i;
for(int i=0;wynik-1000*cyfra_1-100*cyfra_2-10*cyfra_3>=i;i++)
cyfra_4=i;
PORT_SEG=SEG_1;
PORT_WYS=na_wyswietlacz(cyfra_1);
miganie;
PORT_SEG=SEG_2;
PORT_WYS=na_wyswietlacz(cyfra_2) & 0b11111011;
miganie;
PORT_SEG=SEG_3;
PORT_WYS=(na_wyswietlacz(cyfra_3));
miganie;
PORT_SEG=SEG_4;
PORT_WYS=na_wyswietlacz(cyfra_4);
miganie;
if(przycisk(1<<PD5))
sygnal=0;
}
}
uint8_t na_wyswietlacz(uint8_t zmienna) //definicje liczb do wyswietlania na wysw.
{
if (zmienna==1)
return 0B01111101;
else if (zmienna==2) // 7 10 11 1 2 3 4 5
return 0B01000110;
else if (zmienna==3)
return 0B01010100;
else if (zmienna==4)
return 0B00111100;
else if (zmienna==5)
return 0b10010100;
else if (zmienna==6)
return 0B10000100;
else if (zmienna==7)
return 0B01011101;
else if (zmienna==8)
return 0B00000100;
else if (zmienna==9)
return 0b00010100;
else if (zmienna==0)
return 0b00000101;
else if (zmienna==15)
return 0b00000000;
else
return 0b11111110;
}
ISR(TIMER0_COMP_vect)
{
if (sygnal<6) //generowanie sygnalu na TRIG
{
PORTB|=(1<<PB1);
sygnal++;
}
else if (odleglosc<65000) //odmierzanie czasu
{
PORTB &=~(1<<PB1);
odleglosc++;
}
}
ISR(INT0_vect)
{
if (flaga==0)
{
odleglosc=0;
TCNT0=0;
MCUCR=(0<<ISC00)|(1<<ISC01);
flaga=1;
//PORTD|=(1<<PD7);
}
else
{
wynik=odleglosc;
MCUCR=(1<<ISC00)|(1<<ISC01);
flaga=0;
//PORTD|=(1<<PD7);
//PORTD&=~(1<<PD7);
}
}
int przycisk(uint8_t ktory) //sprawdzenie czy wciśniety przycisk (
{
uint8_t c=100, b=0;
if ((PIND & ktory)==0)
{
while (b==0)
{
c--;
if (PIND & ktory)
b=1;
else if (c==0)
b=1;
}
while(b==1)
{
PORT_SEG=SEG_1;
PORT_WYS=na_wyswietlacz(1);
miganie;
PORT_SEG=SEG_2;
PORT_WYS=na_wyswietlacz(2) & 0b11111011;
miganie;
PORT_SEG=SEG_3;
PORT_WYS=(na_wyswietlacz(3));
miganie;
PORT_SEG=SEG_4;
PORT_WYS=na_wyswietlacz(4);
miganie;
if (PIND & ktory)
b=0;
}
}
if (c==0)
return 1;
else
return 0;
}[/syntax]Statystyki: Napisane przez _damian — 14 lip 2015, o 19:08
]]>