Page 565 - 2

void xy(unsigned int x,unsigned int y);
unsigned int flag,cnt,j;
bit timestart,ccnt,start = 0 ;

void servo1(void) // 서보모터 +90 도
{
int i;
for(i=0;i<=100;i++)
{
motor = 1;
delay_us(2500);
motor = 0;
delay_ms(20);
}
}
void servo2(void) // 서보모터 +0 도
{
int i;
for(i=0;i<=100;i++)
{
motor = 1;
delay_us(1500);
motor = 0;
delay_ms(20);
}
}
void lcd_cmd(unsigned char cmd) //lcd 커맨드 전송함수
{
// 명령어 상위 4 비트 전송
PORTG = 0x04;
PORTC = cmd&0xf0; // 명령어 전송
PORTG &= 0xfb;
// 명령어 하위 4 비트 전송
PORTG = 0x04;
PORTC = cmd<<4;
PORTG &= 0xfb;
delay_ms(200);
}

void lcd_init(void) //LCD 초기화 함수이면서 PORT 설정
{
DDRG = 0x07; //PORTG.0,1,2 를 출력으로 설정
DDRA = 0xff; //PORTA 전체를 출력으로 설정
DDRC = 0xf0; //PORTC 상위 4 비트만 출력으로 설정
DDRD = 0x00; //PORTD 전체 입력으로 설정

- 565 -