📄 kechengsheji.c
字号:
#include<spce061a_chf.h>
extern count;
void up();//前进函数
void down();//后退函数
void left();//左转函数
void right();//右转函数
void stop();//停止函数
void delay1();
void delay2();//延迟函数
void khz_38();//产生方波的函数
int main()
{
unsigned int value;
Set_IOA_Dir(0x00ff);
Set_IOA_Attrib(0x00ff);
Set_IOA_Data(0x0000);
*P_IOB_Dir=0xFFFF;
*P_IOB_Attrib=0xFFFF;
*P_IOB_Data=0xFFFF;
Set_SystemClock(0x0078);//PLL:40.96MHz,Fosc:40.96MHz
*P_TimerB_Ctrl=0x0200; //TimerA:20.48MHz,占空比为8/16
*P_TimerB_Data=0xFFDF; //10 ms
*P_INT_Ctrl=0x8000;
asm("INT fiq");
while(1)
{
Watchdog_Clear();
khz_38();//产生方波
value=Get_IOB_Data()^0xffff;
switch(value)
{
case 0x0001:{stop();//前方有障碍物就停止
left();//先左转
delay1();//转90度
stop();//转完后停止
break;}
case 0x0002:{right();
delay2();//偏离了跑道就小角度调整
break;}//右转
case 0x0003:{left();
delay2();//偏离了跑道就小角度调整
break;}//左转
case 0x0004:{left();
delay2();//偏离了跑道就小角度调整
break;}//出了右边界线
case 0x0005:{right();
delay2();//偏离了跑道就小角度调整
break;}//出了左边界线
default: break;//全为0就说明没有情况
}
up();//前进
}
}
void up()
{
Set_IOA_Data(0x0017);
}
void stop()
{
Set_IOA_Data(0x0000);
}
void left()
{
Set_IOA_Data(0x001b);
}
void right()
{
Set_IOA_Data(0x0027);
}
void delay1()
{
unsigned int i=0xffff;
while(i--)
{
Watchdog_Clear();
}
}
void delay2()
{
unsigned int i=0x00ff;
while(i--)
{
Watchdog_Clear();
}
}
void khz_38()
{
unsigned int i=0x0200;
if(count==10)//定时发送方波的程序
{
count=0;
i^=0x0200;
*P_TimerB_Ctrl=i;
}
}
⌨️ 快捷键说明
复制代码
Ctrl + C
搜索代码
Ctrl + F
全屏模式
F11
切换主题
Ctrl + Shift + D
显示快捷键
?
增大字号
Ctrl + =
减小字号
Ctrl + -