motor_text.c

来自「机器人部分C语言编码 c语言 供大家参考学习」· C语言 代码 · 共 56 行

#include "p89v51rx2.h"
#include "constant_type.h"
#include "delay.h"
#include "global.h"
#include "lcd.h"
#include "motor.h"
void main()
{
	LCD_Init();
	delay_ms(50);
	LCD_clear();
	LCD_write_string(0,3,"text motor");
	init_motor();
	key_on_off(1);
	 EA=1;
	while(1)
	{
	motor_ISR();
		if(KEY_1==0)
		{
			delay_ms(50);
			if(KEY_1==0)
			{

			   go_forward(20);
				delay_ms(3000);	
				go_right_fast(20);
				delay_ms(3000);
				go_left_fast(20);
				delay_ms(3000);
				go_right_slow(20);
				delay_ms(3000);
				go_left_slow(20);
				delay_ms(3000);
				go_back(20);							
				
			}
		}
		if(KEY_2==0)
		{
			delay_ms(50);
			if(KEY_2==0)
			{	
			
	
				stop();
			}
		}
		
		

	}
	
}