单排机循迹小车的最终代码

最新推荐文章于 2018-07-20 17:04:33 发布

啊啊啊啊啊啊啊阿

最新推荐文章于 2018-07-20 17:04:33 发布

阅读量569

点赞数

分类专栏：单片机的学习

本文链接：https://blog.csdn.net/qq_34528825/article/details/53073751

版权

单片机的学习专栏收录该内容

23 篇文章 2 订阅

订阅专栏

<pre name="code" class="cpp">#include <reg52.h>

sbit IN1 = P1^4; //ÓÒÂÖÇý¶¯
sbit IN2 = P1^3;

sbit IN3 = P1^2; //×óÂÖÇý¶¯
sbit IN4 = P1^1;

void run()
{
	IN1 = 0;
	IN2 = 1;

	IN3 = 0;
	IN4 = 1;
	
}

void turn_left_min() //Ð¡×ó×ªÍä(×óÂÖÇ°½ø£¬ÓÒÂÖÇ°½ø)
{
	IN1 = 0;
	IN2 = 1;

	IN3 = 0;
	IN4 = 1;
	
}

void turn_left_max() //´ó×ó×ªÍä(×óÂÖºóÍË£¬ÓÒÂÖÇ°½ø£©
{
	IN1 = 0;
	IN2 = 1;

	IN3 = 1;
	IN4 = 0;
}

void turn_right_min() //Ð¡ÓÒ×ªÍä£¨×óÂÖÇ°½ø£¬ÓÒÂÖÇ°½ø£©
{
	IN1 = 0;
	IN2 = 1;
	
	IN3 = 0;
	IN4 = 1;
}

void turn_right_max() //´óÓÒ×ªÍä£¨×óÂÖÇ°½ø£¬ÓÒÂÖºóÍË£©
{
	IN1 = 1;
	IN2 = 0;
	
	IN3 = 0;
	IN4 = 1;
}

void stop()
{
	IN1 = 0;
	IN2 = 0;
	
	IN3 = 0;
	IN4 = 0;
}

#include <reg52.h>#include "./turn/turn.h"#define uint unsigned int #define uchar unsigned charsbit ENA = P1^5;//右驱动sbit ENB = P1^0; //左驱动sbit xj_l2 = P3^0;//左1循迹口sbit xj_l1 = P3^1;//左2循迹口sbit xj_r1 = P3^2;//右1循迹口sbit xj_r2 = P3^3;//右2循迹口uchar ZKB_L = 0; //左轮占空比uchar ZKB_R = 0; //右轮占空比uchar pwm;uchar num = 0;//对中断次数计数void timer0_init(){TMOD |= 0x01;EA = 1;TH0 = (65536 - 500) / 256;TL0 = (65536 - 500) % 256;ET0 = 1;TR0 = 1;}void timer0_isr() interrupt 1{TR0 = 0;TH0 = (65536 - 500) / 256;TL0 = (65536 - 500) % 256;num++;if(num > 32){num = 0;}if(num <= ZKB_L) {ENA = 1;}else{ENA = 0;}if(num <= ZKB_R){ENB = 1;}else{ENB = 0;}TR0 = 1;}void xunji() //循迹函数{if((xj_l2 == 0)&(xj_l1 == 0)&(xj_r1 == 0)&(xj_r2 == 0)){run();ZKB_L = 10;ZKB_R = 10;}if((xj_l2 == 0)&(xj_l1 == 1)&(xj_r1 == 0)&(xj_r2 == 0)){turn_right_min(); ZKB_L = 10;ZKB_R = 7;}if((xj_l2 == 0)&(xj_l1 == 0)&(xj_r1 == 1)&(xj_r2 == 0)){turn_left_min();ZKB_L = 7;ZKB_R = 10;}if((xj_l2 == 1)&(xj_l1 == 0)&(xj_r1 == 0)&(xj_r2 == 0)){turn_left_max();ZKB_L = 5;ZKB_R = 10;}if((xj_l2 == 0)&(xj_l1 == 0)&(xj_r1 == 0)&(xj_r2 == 1)){turn_right_max();ZKB_L = 10;ZKB_R = 5;}if((xj_l2 == 1)&(xj_l1 == 1)&(xj_r1 == 1)&(xj_r2 == 1)){stop();} }void main(){timer0_init();while(1){xunji();}}