วันจันทร์ที่ 14 มกราคม พ.ศ. 2562

T17





#line 1 "C:/Users/bunthit/Desktop/TEST 1/T17.c"
void main()
{
 unsigned char rcw,rccw;
 unsigned char step_cw[]={0x01,0x02,0x04,0x08};
 unsigned char step_ccw[]={0x04,0x02,0x01,0x08};
 unsigned char keypad[]={0,1,2,3,0,
 4,5,6,0,
 7,8,9,0,
 0,0,0,0};
 unsigned char i,m,kp;
 TRISB=0;
 TRISC=0;
 TRISD=0xFF;
 Lcd_Init(&PORTB);
 Keypad_Init(&PORTD);
 Lcd_Cmd(LCD_CURSOR_OFF);
 Return:Lcd_Cmd(LCD_CLEAR);
 Lcd_Out(1,1,"Rotate CW?");
 while(!Keypad_Read());
 kp=Keypad_Read();
 rcw=keypad[kp];
 Lcd_Chr(2,1,keypad[kp]+48);
 while(Keypad_Read());
 while(Keypad_Read()!=15);
 while(Keypad_Read());
 Lcd_Cmd(LCD_CLEAR);
 Lcd_Out(1,1,"Rotate CCW?");
 while(!Keypad_Read());
 kp=Keypad_Read();
 rccw=keypad[kp];
 Lcd_Chr(2,1,keypad[kp]+48);
 while(Keypad_Read());
 while(Keypad_Read()!=15);
 while(Keypad_Read());
 Lcd_Cmd(LCD_CLEAR);
 Lcd_Out(1,1,"Rotating...");
 for(i=0;i<rcw;i++)
 {
 while(m<4)
 {
 PORTC=step_cw[m];
 delay_ms(500);
 m++;
 }
 m=0;
 }
 for(i=0;i<rccw;i++)
 {
 while(m<4)
 {
 PORTC=step_ccw[m];
 delay_ms(500);
 m++;
 }
 m=0;
 }
 goto Return;
}

ไม่มีความคิดเห็น:

แสดงความคิดเห็น