在住程序里面改成小车能按照黑色轨迹来走就可以了。a0是左边的传感器,a1是右边的传感器。a<100是在黑色轨迹上。a>100是在白色纸张上。要遥控启动车子。是智能小车来的。<br /><br /><br /><br /><br />#include <hidef.h> /* for EnableInterrupts macro */<br />#include "MC68HC908JL3.h" /* include peripheral declarations */<br />#define MiddleLight PTD_PTD5 /* 前进方向指示灯控制变量 */<br />#define LeftLight PTD_PTD4 /* 左转方向指示灯控制变量 */<br />#define RightLight PTD_PTD2 /* 右转方向指示灯控制变量 */<br />#define On 0 /* 指示灯为共阳接法 */<br />#define Off 1 /* 指示灯为共阳接法 */<br />#define True 1 /* */<br />#define False 0 /* */<br /><br />#define SoundControl PTD_PTD0 /* 蜂鸣器的控制变量 */<br /><br />#define LA PTA_PTA3 /* 左电机LA */<br />#define LB PTA_PTA2 /* 左电机LB */<br />#define RA PTD_PTD7 /* 右电机LA */<br />#define RB PTD_PTD6 /* 右电机LB */<br /><br />#define FrontSensor PTA_PTA5//PTA_PTA5 /* 前端传感器,0:有障碍物 */<br />#define BackSensor PTB_PTB0 /* 后端传感器,0:有障碍物 */<br />#define FrontLeftInfrared PTB_PTB1 /* 左前红外传感器,0:有障碍物 */<br />#define FrontRightInfrared PTB_PTB2 /* 右前红外传感器,0:有障碍物 */<br />#define FrontMiddleInfrared PTB_PTB3 /* 右后红外传感器,0:有障碍物 */<br />#define BackLeftInfrared PTB_PTB4 /* 左后红外传感器,0:有障碍物 */<br /><br /><br /><br />//定义变量=================================================================<br /><br />uchar cont_10ms; //为得到10ms时间平台计数器<br />uchar AD_buf;//保存AD转换值<br /><br />//蜂鸣器相关变量==========================================================<br />uchar beef_daley;//响蜂鸣持续时间<br />uchar beef_figer;//响蜂鸣器标记<br />uchar beef_time; //设置响蜂鸣器次数的变量<br />//=======================================================================<br />uchar ch;<br />uchar a[7];<br /><br />uchar run_mode;<br /><br />//遥控相关的变量===========================================================<br />uchar rest_time;//遥控接收时间计数器计数时间平台0.125ms<br />uchar rxtime_buf;//暂存遥控接收时间计数器数据的变量<br />uchar rx_figer; //头码接收标记<br />uchar RCV_STEP; //接收阶段<br />uchar RCV_CONT; //接收数据位数计数变量<br />uchar rx_data;//遥控返回的得到内码<br />uchar RCV_BUF[4]={0};//接收数据缓冲数组<br />uchar RCV_CODE[9]={0x1a,0x13,0x0a,0x0b,0x0f,0x02,0xfc,0x0e,0x12 };//查遥控内码表<br /><br /><br /><br />//以下为用户程序编写区 ============================================================<br /><br />//初始化AD================================================================== <br />void initAd(void) <br /> { <br /> ADICLK = 0x30; //设置AD转换器的时钟源及分频系数<br /> ADSCR=ch; //设置AD转换器的启动,中断允许及转换通道<br /> }<br /> <br /><br /><br /><br /><br /><br />//AD管理=====================================================================<br />void AD_porm(void) //每次调用该函数则启动一次AD转换,该AD通道为1<br />{ initAd();<br /> for(;;)<br /> {<br /> <br /> if(0x80==(ADSCR&0x80)) //等待转换结束<br /> { a[ch-1]=ADR; //将AD转换得到值保存在AD_buf里<br /> ch++;<br /> if(ch>7)<br /> ch=1;<br /> break;<br /> }<br /> }<br /> <br /> <br /> <br /> <br /> <br />}<br /><br /><br /><br /><br /> //蜂鸣器管理================================================================<br /> void beef_conr(void) <br /> { if(beef_daley==0) //若蜂鸣器工作时间结束,<br /> { if(beef_figer==1)//若已响过蜂鸣则要关掉蜂器<br /> { <br /> beef_daley=20;//送蜂鸣器间隔时间<br /> beef_figer=0;//清响蜂鸣器标记<br /> <br /> <br /> } <br /> else <br /> {if(beef_time>0)//若前面没有响蜂鸣且还没有达到要响次数则继续响<br /> {beef_figer=1; //允许响蜂鸣器<br /> beef_time--; //响的次数减1<br /> beef_daley=20;//响蜂鸣器的时间<br /> }<br /> <br /> }<br /> <br /> <br /> <br /> }<br /> }<br /><br /><br /><br /><br /><br />//溢出中断================================================================== <br /> <br /> interrupt 6 void Timer_Interrupt(void)<br /> { <br /> TSC=TSC&0x7f; //清溢出中断标记<br /> TMODH = 0; <br /> TMODL = 250;<br /> <br /> rest_time++;<br /> if(rest_time>159) <br /> { rx_figer=0;<br /> RCV_STEP=0;<br /> RCV_CONT=0; <br /> rest_time=0;<br /> <br /> }<br /> <br /> //蜂鸣器驱动===========================================<br /> if(beef_figer==1)<br /> PTD=PTD^1;//对PTD的第0位引脚取反产生振荡信号<br /> else<br /> PTD=PTD&0xfe;<br /> <br /> <br /> //=====================================================<br /> cont_10ms++; //为得到10ms计数器,每隔0.125ms计数一次<br /> if(cont_10ms>79)<br /> {<br /> //10ms时间平台====================================<br /> <br /> cont_10ms=0;<br /> if(beef_daley>0)<br /> beef_daley--; //对自减响蜂鸣的时间<br /> <br /> <br /> <br /> }<br /> <br /> <br /> <br /> }<br /> <br /> <br /> <br /> <br /> //外中断=====================================================================<br />//外中断主要负责遥控接收每按一次遥控器键盘时返回一个遥控内码保存在rx_data变量里<br />interrupt 2 void IRQ_Interrupt(void) <br /> {<br /> char i; <br /> rxtime_buf=rest_time;<br /> rest_time=0;<br /> if(rx_figer&1) <br /> { if((rxtime_buf>4)&&(rxtime_buf<23)) <br /> { if(rxtime_buf<=13) <br /> { <br /> RCV_CONT++;<br /> RCV_BUF[RCV_STEP]=RCV_BUF[RCV_STEP]>>1; <br /> RCV_BUF[RCV_STEP]=RCV_BUF[RCV_STEP]|0x80;<br /> <br /> }<br /> <br /> else <br /> if(rxtime_buf>=14) <br /> { <br /> RCV_BUF[RCV_STEP]=RCV_BUF[RCV_STEP]>>1; <br /> RCV_BUF[RCV_STEP]=RCV_BUF[RCV_STEP]&0x7f;<br /> RCV_CONT++;<br /> <br /> } <br /> <br /> <br /> if(RCV_CONT==8) <br /> { <br /> RCV_STEP++;<br /> RCV_CONT=0;<br /> <br /> }<br /> <br /> if(RCV_STEP>3) <br /> { <br /> rx_figer=0;<br /> RCV_STEP=0;<br /> RCV_CONT=0;<br /> <br /> for(i=0;i<10;i++) <br /> { if(RCV_BUF[3]==RCV_CODE) <br /> { <br /> <br /> rx_data=i;<br /> <br /> beef_time=rx_data;<br /> break; <br /> }<br /> <br /> }<br /> <br /> <br /> <br /> ;<br /> <br /> }<br /> <br /> }<br /> <br /> } <br /> <br /> else<br /> { if((rxtime_buf>104)&&(rxtime_buf<112)) <br /> { <br /> rx_figer=1;<br /> RCV_STEP=0;<br /> RCV_CONT=0; <br /> }<br /> <br /> <br /> <br /> }<br /><br /> }<br /> <br /> <br /> <br /> <br />//外中断初始化=============================================================<br /> <br /> <br /> void init_IRQ(void)<br /> <br /> { INTSCR=0x00;//设置外中断信号为下降沿触发<br /> <br /> }<br /> <br /> <br /> <br /> <br />//定时器初始化==============================================================<br />void InitTimer(void) <br /> {<br /> <br /> TMODH = 0; //设置定时器预置寄存器的高8位值为0<br /> TMODL = 250; //设置定时器预置寄存器的低8位值为250<br /> TSC=0x40; //<br /> }<br /> <br /> <br />//软件延时==================================================================<br />void daley(int x)<br />{<br /> int c; <br /> for(c=0;c<x;c++) <br /> ;<br /> }<br /> <br /> <br /><br /><br /> <br /> <br /> //MCU初始化================================================================<br />void MCU_init(void)<br /> { CONFIG1=1; <br /> <br /> <br /> PTD=0x00;<br /> PTB=0xff;<br /> PTA=0;<br /> DDRA=0xff;<br /> DDRD=0xff; //PTD口作为输出<br /> DDRB=0x00; //PTB口作为输入<br /> InitTimer(); //定时器初始化<br /> init_IRQ();<br /> EnableInterrupts//开总断 <br /> } <br /> <br /> <br /> <br /> //========================================================================= <br />/********* 停止模块 ***********/<br />void RunStop(void) <br />{ <br /> //设置电机控制变量<br /> LA = 0;<br /> LB = 0;<br /> RA = 0;<br /> RB = 0;<br /> <br /> //设置指示灯<br /> MiddleLight = Off;<br /> LeftLight = Off;<br /> RightLight = Off;<br />}<br /><br />/********* 前进模块 ***********/<br />void RunForward(void) <br />{ <br /> <br /> LA = 1;<br /> LB = 0;<br /> RA = 1;<br /> RB = 0;<br /> <br /> <br /> //设置指示灯<br /> MiddleLight = On;<br /> LeftLight = Off;<br /> RightLight = Off;<br />}<br /><br />/********* 后退模块 ***********/<br />void RunBackward(void) <br />{ <br /> //设置电机控制变量<br /> LA = 0;<br /> LB = 1;<br /> RA = 0;<br /> RB = 1;<br /> <br /> //设置指示灯<br /> MiddleLight = On;<br /> LeftLight = On;<br /> RightLight = On;<br />}<br /><br />/********* 左转模块 ***********/<br />void RunLeft(void) <br />{ <br /> //设置电机控制变量<br /> LA = 0;<br /> LB = 1;<br /> RA = 1;<br /> RB = 0;<br /> <br /> //设置指示灯<br /> MiddleLight = Off;<br /> LeftLight = On;<br /> RightLight = Off;<br />}<br /><br />/********* 原地左转模块 *******/<br />void RunLeftRoundLeft(void) <br />{ <br /> //设置电机控制变量<br /> LA = 0;<br /> LB = 0;<br /> RA = 1;<br /> RB = 0;<br /> <br /> //设置指示灯<br /> MiddleLight = Off;<br /> LeftLight = On;<br /> RightLight = Off;<br />}<br /><br />/********* 右转模块 ***********/<br />void RunRight(void) <br />{ <br /> //设置电机控制变量<br /> LA = 1;<br /> LB = 0;<br /> RA = 0;<br /> RB = 1;<br /> <br /> //设置指示灯<br /> MiddleLight = Off;<br /> LeftLight = Off;<br /> RightLight = On;<br />}<br /><br />/********* 原地右转模块 *******/<br />void RunRightRoundRight(void) <br />{ <br /> //设置电机控制变量<br /> LA = 1;<br /> LB = 0;<br /> RA = 0;<br /> RB = 0;<br /> <br /> //设置指示灯<br /> MiddleLight = Off;<br /> LeftLight = Off;<br /> RightLight = On;<br />} <br /> <br /> <br />void run_md(void)<br /> { if(run_mode==1)<br /> RunStop();<br /> else<br /> if(run_mode==2)<br /> RunForward();<br /> else<br /> if(run_mode==3)<br /> RunLeft();<br /> else<br /> if(run_mode==4) <br /> RunRight(); <br /> <br /> <br /> <br /> <br /> }<br /> <br /> <br /> void ad_to_mode(void)<br /> {if((a[0]<240)&&(a[1]<240)) <br /> {if(a[0]>a[1]) <br /> {<br /> if((a[0]-a[1])>25)<br /> run_mode=3;<br /> else<br /> run_mode=2;<br /> } <br /> else<br /> if(a[1]>a[0]) <br /> {if((a[1]-a[0])>25)<br /> run_mode=4;<br /> else<br /> run_mode=2;<br /> }<br /> }<br /> else<br /> if((a[0]>240)&&(a[1]<240)) <br /> { <br /> if(a[1]>220)<br /> run_mode=4;<br /> else<br /> if(a[1]<180)<br /> run_mode=3;<br /> else<br /> if((a[1]>180)&&(a[1]<220))<br /> run_mode=2;<br /> <br /> <br /> } <br /> else<br /> if((a[1]>240)&&(a[0]<240)) <br /> { <br /> if(a[0]>220)<br /> run_mode=3;<br /> else<br /> if(a[0]<180)<br /> run_mode=4;<br /> else<br /> if((a[0]>180)&&(a[0]<220))<br /> run_mode=2;<br /> <br /> <br /> }<br /> <br /> <br /> <br /> <br /> }<br /><br />//main程序=================================================================== <br />void main(void) <br />{<br /> <br /> daley(100);//系统延时<br /> MCU_init();//单片机初始化<br /> EnableInterrupts;<br /> beef_time=1;<br /> //主控程序============================================== <br /> for(;;) <br /> { beef_conr(); <br /> AD_porm();<br /> //run_md();<br /> //ad_to_mode();<br /> // <br /> <br /> //if((a[0]<100)&&(a[1]<100))<br /> //{<br /> <br /> /// RunBackward(); <br /> //}<br /> //else<br /> //{ RunForward(); <br /> <br /> //}<br /> if(rx_data==8)<br /> { rx_data=0;<br /> RunForward();<br /> }<br /> else<br /> if(rx_data==1)<br /> { rx_data=0; <br /> RunLeftRoundLeft();<br /> }<br /> else <br /> if(rx_data==3)<br /> { rx_data=0; <br /> RunStop();<br /> } <br /> <br /> <br /> }<br /> <br /> <br /> <br /> } <br /> <br /> <br /> <br />//下面的与应用程序无关不必去看========================================================================== <br /> <br />interrupt 15 void Timer15_Interrupt(void) { ;}<br />interrupt 14 void Timer14_Interrupt(void) { ;} <br />interrupt 13 void Timer13_Interrupt(void) { ;} <br />interrupt 12 void Timer12_Interrupt(void) { ;}<br />interrupt 11 void Timer11_Interrupt(void) { ;}<br />interrupt 10 void Timer10_Interrupt(void) { ;}<br />interrupt 9 void Timer9_Interrupt(void) { ;} <br />interrupt 8 void Timer8_Interrupt(void) { ;} <br />interrupt 7 void Timer7_Interrupt(void) { ;}<br />interrupt 5 void Timer5_Interrupt(void) { ;}<br />interrupt 4 void Timer4_Interrupt(void) { ;}<br />interrupt 3 void Timer3_Interrupt(void) { ;} <br /><br />interrupt 1 void Timer1_Interrupt(void) { ;} |
|