/***********************************
功能:KC机器人的学习(小车先向前运动,左右摇摆后返回)
说明:机器人的移动(利用数组保存运动状态)
时间:2012.12.12
附录:脉冲数量:3/0.023=130个(3S)
***********************************/
#include<Boebot.h>
#include<uart.h>
int main()
{
int Pulses_Count[5]={65,26,26,65,0};
int Pulses_Lift[4]={1700,1300,1700,1300};
int Pulses_Right[4]={1300,1300,1700,1700};
int address=0;
int counter;
uart_Init();
printf("Program Running!!\n");
while(Pulses_Count[address]!=0)
{
for(counter=1;counter<=Pulses_Count[address];counter++)
{
P1_1=1;
delay_nus(Pulses_Lift[address]);
P1_1=0;
P1_0=1;
delay_nus(Pulses_Right[address]);
P1_0=0;
delay_nms(20);
}
address++;
}
while(1);
}