Page 539 - 2

while(!(UCSR0A & 0x20));
UDR0 = angle[flag]/100%10 + '0';

while(!(UCSR0A & 0x20));
UDR0 = angle[flag]/10%10 + '0';

while(!(UCSR0A & 0x20));
UDR0 = angle[flag]%10 + '0';

while(!(UCSR0A & 0x20));
UDR0 = ' ';
flag++;
}
*/

// 플래그와 앵글에따른 모터 제어
count++;
if(count >= MAX) { //20ms 때 마다
for(i = 0; i < 5; i++) if((angle[i]>166) || (angle[i]<0)) angle[i] = 0;
count = 0;
MOT1 = 1;
MOT2 = 1;
MOT3 = 1;
MOT4 = 1;
MOT5 = 1; // MOT1~MOT5( 서보모터 의 신호선에) ' 1 ' 이 입력
temp[0] = (166-angle[0]) + MIN; // 엄지
temp[1] = (166-angle[1]) + MIN; // 검지
temp[2] = (166-angle[2]) + MIN; // 중지
temp[3] = (angle[3]) + MIN; // 약지
temp[4] = (angle[4]) + MIN; // 소지

}
else {
if(count == temp[0]) MOT5 = 0;
if(count == temp[1]) MOT4 = 0;
if(count == temp[2]) MOT3 = 0;
if(count == temp[3]) MOT2 = 0;
if(count == temp[4]) MOT1 = 0; // Temp 의 값에 따라 MOT1~MOT5( 서보모터 의 신호선에) ' 0 '
이 입력
}

- 539 -