《基于51单片机智能小车循迹程序.doc》由会员分享,可在线阅读,更多相关《基于51单片机智能小车循迹程序.doc(18页珍藏版)》请在taowenge.com淘文阁网|工程机械CAD图纸|机械工程制图|CAD装配图下载|SolidWorks_CaTia_CAD_UG_PROE_设计图分享下载上搜索。
1、#include #include #define uint unsigned int#define uchar unsigned char/*/ uchar led_data9=0xc0,0xf9,0xa4,0xb0,0x99,0x92,0x82, 0xf8,0x80; uchar circle=0,cir_comp=0,cir_count=0;/设定圈数,实际圈数 uchar turn_count=0; bit end=0; /圈数跑完标志/*/sbit xg0=P10;/左寻轨对管sbit xg1=P11;/中间寻轨对管sbit xg2=P12;/右寻轨对管sbit xz=P13;/感应
2、挡板对管/*/sbit Q_IN1=P20; /车前左轮控制 sbit Q_IN2=P21;sbit Q_IN3=P22; /车前右轮控制sbit Q_IN4=P23; sbit H_IN1=P24; /车尾左轮控制sbit H_IN2=P25;sbit H_IN3=P26; /车尾右轮控制sbit H_IN4=P27;sbit Q_ENA=P30; /车前左轮使能,PWMsbit Q_ENB=P31; /车前右轮使能,sbit H_ENA=P36; /车尾左轮使能,sbit H_ENB=P37; /车尾右轮使能,/*/#define stra_q_l 100 /直线行走时,四个轮子占空比调试
3、#define stra_q_r 100#define stra_h_l 100#define stra_h_r 100#define turn_q_l 100 /转弯时四个轮子的占空比调试#define turn_q_r 100#define turn_h_l 100#define turn_h_r 100 #define turnr_time 2900/右转弯时的延时常数#define turnl_time 3000 /左转弯时的延时常数#define dt_time 5800 /原地掉头时延时常数#define over_time 1000 /停止延时#define back_time
4、2500 /走完环形,回到直道延时转弯#define black_time 1500 /过黑线的时间#define correct_l_time 700 /左矫正时间#define correct_r_time 700 /右矫正时间#define hou_time 200/*/ uchar q_duty_l,q_duty_r,h_duty_l,h_duty_r,/车前后左右轮占空比 i=0,j=0,k=0,m=0;/*/ void delay_cir(uint n) uchar x; while(n-) for(x=0; x=9)turn_count=0; cir_count+; circle
5、-;if(cir_count=cir_comp) end=1; over(); delay(500); else if(xg0=0)&(xg1=0)&(xg2=0) straight(); else if(xg0=1)&(xg1=0)&(xg2=0) over(); delay(over_time); houtui(); delay(hou_time); correct_right(); /左偏,向右矫正 else if(xg0=0)&(xg1=0)&(xg2=1) over(); delay(over_time); houtui(); delay(hou_time); correct_lef
6、t(); /右偏,向左矫正 /*/void int0(void) interrupt 0/中断圈数设定 EX0=0; delay_cir(250); circle+; cir_comp+; if(circle8) circle=0; cir_comp=0; P0=led_datacircle; EX0=1;/*/void time1(void) interrupt 3 /T1溢出中断,电机调速 i+; j+; k+; m+; if(i100) Q_ENA=1;i=0; if(j100 ) Q_ENB=1;j=0; if(k100) H_ENA=1;k=0; if(m100) H_ENB=1;m=0; P0=led_datacircle; TH1=0XFF; TL1=0XF6; /*/void main() P0=led_datacircle; P1=0xFF; P1=0XFF; /P1口做输入 P2=0X00; /P2口初始化,小车禁止 P3=0XFF; TMOD=0X11;/T0,T1,工作方式1 TH1=0XFF; /T1中断一次10US TL1=0XF6; TR1=1; EX0=1; ET1=1; EA=1; while(1) while(xz=1)&(end!=1) /无挡板,扫描对管,前进 xunji(); ;仅供学习参考