MicroprocessorDesignAndPractice/test.c at main · UDADDY/MicroprocessorDesignAndPractice · GitHub

1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
#include <avr/io.h>
#define F_CPU 16000000UL
#include <util/delay.h>

#define TRIG 6  // 포트 E의 6번핀
#define ECHO 7  // 포트 E의 7번핀

unsigned char digit[10] = {0x3f, 0x06, 0x5b, 0x4f, 0x66, 0x6d, 0x7c, 0x07, 0x7f, 0x67};
unsigned char fnd_sel[4] = {0x01, 0x02, 0x04, 0x08};
unsigned char fnd[4];
int is_empty = 0;
int criterion = 100;

void display_fnd(unsigned int value);

int main(void)
{
    unsigned int distance;
    // fnd
    DDRC = 0xff;
    DDRG = 0x0f;
    // ultrasonic
    // TRIG는 출력으로 ECHO는 입력으로
    DDRE = ((DDRE|(1<<TRIG)) & ~(1<<ECHO));

	// led
	DDRA = 0xff;

    while(1)
    {
        TCCR1B = 0x02;  // 분주비 설정  0b00000010
        PORTE &= ~(1<<TRIG);
        _delay_us(10);
        PORTE |= (1<<TRIG);
        _delay_us(10);
        PORTE &= ~(1<<TRIG);

        while(!(PINE & (1<<ECHO)));
            TCNT1 = 0x0000;
        while(PINE & (1<<ECHO)) ;

        TCCR1B = 0x00;
        distance = (unsigned int)(TCNT1 / 2 / 5.8);
        display_fnd(distance);

		if(distance < criterion)
			PORTA = 0xff;
		else
			PORTA = 0x00;
    }
}

void display_fnd(unsigned int value)
{
    int i;
    fnd[3] = (value/1000)%10;
    fnd[2] = (value/100)%10;
    fnd[1] = (value/10)%10;
    fnd[0] = (value/1)%10;
    for(i=0; i<4; i++)
    {
        PORTC = digit[fnd[i]]; //| (i==1 ? 0x80 : 0x00);
        PORTG = fnd_sel[i];
        _delay_ms(2);
        if(i%2)
        _delay_ms(1);
    }
}