motor_text.c

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

#include "p89v51rx2.h"
#include "constant_type.h"
#include "delay.h"
#include "global.h"
#include "motor.h"
void main()
{
	init_motor();
	key_on_off(1);
	while(1)
	{
		
		if(KEY_1==0)
		{
			delay_ms(50);
			if(KEY_1==0)
			{
				go_forward(20);
				delay_ms(1000);
				go_back(10);
				delay_ms(1000);
				go_right_fast(20);
				delay_ms(1000);
				go_left_fast(20);
				delay_ms(1000);
				go_right_slow(20);
				delay_ms(1000);
				go_left_slow(20);
				delay_ms(1000);			
			}
		}
		if(KEY_2==0)
		{
			delay_ms(50);
			if(KEY_2==0)
			{				
				stop();
			}
		}
		
		

	}
	
}