Page 46 - MDP2022-3

void zero_fnd() //FND에 '0'을 띄우는 함수 선언
{
static int pos_fnd = 0;

switch(pos_fnd)
{
case 0:
PORTB = 0b00010000 | 0;
PORTC = 0b00010000 | 0;
PORTG = 0x18;
break;

case 1:
PORTB = 0b00100000 | 0;
PORTC = 0b00100000 | 0;
PORTG = 0x18;
break;

case 2:
PORTB = 0b01000000 | 0;
PORTC = 0b01000000 | 0;
PORTG = 0x18;
break;

case 3:
PORTB = 0b10000000 | 0;
PORTC = 0b10000000 | 0;
PORTG = 0x18;
break;
}

pos_fnd++;
pos_fnd %= 4;
}

void test_SONIC() //함수 호출할때마다 trig를 통해 초음파 발사(10us 간격)
{
PORTA.0 = 1;
delay_us(10);
PORTA.0 = 0;
}

unsigned long ReadCout(void) //무게 측정 함수 선언