基于51单片机的智能循迹避障小车+C源程序

基于51单片机的智能循迹避障小车+C源程序cinclude"reg52.h"//引脚定义//循迹传感器引脚sbitLeft_Track=P1^0;//左侧循迹传感器sbitMid_Track=P1^1;//中间循迹传感器sbitRight_Track=P1^2;//右侧循迹传感器//超声波传感器引脚sbitTrig=P1^3;//超声波触发引脚sbitEcho=P3^2;//超声波接收引脚(外部中断0)//电机驱动引脚sbitIN1=P2^0;//左电机正转sbitIN2=P2^1;//左电机反转sbitIN3=P2^2;//右电机正转sbitIN4=P2^3;//右电机反转sbitENA=P2^4;//左电机PWM调速(可接PWM口或普通IO口模拟PWM)sbitENB=P2^5;//右电机PWM调速//全局变量unsignedintdistance=0;//障碍物距离unsignedcharobstacle_flag=0;//障碍物标志0:无1:有//函数声明voidInit_System(void);//系统初始化voidMotor_Forward(void);//前进voidMotor_Backward(void);//后退voidMotor_Left(void);//左转(原地或大角度)voidMotor_Right(void);//右转(原地或大角度)voidMotor_Stop(void);//停止voidTrack_Detect(void);//循迹检测与控制voidUltrasonic_Detect(void);//超声波避障检测voidDelay_ms(unsignedintms);//毫秒级延时(软件延时，仅作简单演示)//定时器和外部中断相关函数声明voidInit_Timer0(void);//定时器0初始化(用于延时或PWM)voidInit_External0(void);//外部中断0初始化(用于超声波Echo)//主函数{Init_System();while(1){Ultrasonic_Detect();//先检测是否有障碍物if(obstacle_flag){//有障碍物，执行避障逻辑Motor_Stop();Delay_ms(500);//例如：后退一小段Motor_Backward();Delay_ms(300);Motor_Stop();Delay_ms(200);//左转一定时间(或右转，根据实际情况定)Motor_Left();Delay_ms(600);//调整此延时可改变转向角度Motor_Stop();Delay_ms(200);//前进一小段，避开障碍物Motor_Forward();Delay_ms(800);Motor_Stop();Delay_ms(200);//右转一定时间，回正方向(与上述左转对应)Motor_Right();Delay_ms(600);Motor_Stop();Delay_ms(200);obstacle_flag=0;//清除障碍物标志，重新进入循迹}else{//无障碍物，执行循迹逻辑Track_Detect();}}}//系统初始化voidInit_System(void){//IO口初始化P1=0x00;//传感器端口初始化为低电平P2=0x00;//电机端口初始化为低电平，电机停止P3=0x00;Motor_Stop();//确保初始状态电机停止//初始化定时器和外部中断Init_Timer0();Init_External0();EA=1;//打开总中断}//电机控制函数voidMotor_Forward(void){IN1=1;IN2=0;//左电机正转IN3=1;IN4=0;//右电机正转ENA=1;ENB=1;//全速前进(若用PWM，此处可接PWM信号)}voidMotor_Backward(void){IN1=0;IN2=1;//左电机反转IN3=0;IN4=1;//右电机反转ENA=1;ENB=1;}voidMotor_Left(void){//原地左转示例(可改为差速左转)IN1=0;IN2=1;//左电机反转IN3=1;IN4=0;//右电机正转ENA=1;ENB=1;}voidMotor_Right(void){//原地右转示例(可改为差速右转)IN1=1;IN2=0;//左电机正转IN3=0;IN4=1;//右电机反转ENA=1;ENB=1;}voidMotor_Stop(void){IN1=0;IN2=0;IN3=0;IN4=0;ENA=0;ENB=0;}//循迹检测与控制函数voidTrack_Detect(void){//读取循迹传感器状态unsignedcharleft,mid,right;left=Left_Track;mid=Mid_Track;right=Right_Track;//根据传感器状态控制电机if(mid==1)//中间检测到黑线，前进{Motor_Forward();}elseif(left==1)//左侧检测到黑线，小车偏右，需左转调整{//可实现为轻微左转(差速)或原地小角度左转IN1=0;IN2=0;//左电机停IN3=1;IN4=0;//右电机转ENA=0;ENB=1;//或者通过PWM控制两侧电机转速差实现平滑转向//Motor_Slight_Left();//假设存在轻微左转函数}elseif(right==1)//右侧检测到黑线，小车偏左，需右转调整{IN1=1;IN2=0;//左电机转IN3=0;IN4=0;//右电机停ENA=1;ENB=0;//Motor_Slight_Right();}else//都没检测到或其他情况，停止或特殊处理{Motor_Stop();}}//超声波检测函数voidUltrasonic_Detect(void){unsignedinttime=0;//发送10us以上的触发脉冲Trig=0;Trig=1;Delay_ms(1);//这里实际应是10us以上，为简化用ms级延时，实际需精确Trig=0;//等待Echo返回(此处假设通过外部中断测量Echo高电平时间)//以下为简化逻辑，实际应配合定时器和中断while(!Echo);//等待Echo变高TR0=1;//启动定时器计数while(Echo);//等待Echo变低TR0=0;//停止定时器计数time=TH0*256+TL0;//读取计数值TH0=0;TL0=0;//定时器清零distance=(time*0.017);//计算距离(声速340m/s,time单位为us,0.017=340/2/____)if(dist