久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

<li id="wwyuc"></li>

標題: 單片機小車尋跡（尋黑線）源程序 [打印本頁]

作者: huangminggang 時間: 2018-11-24 20:17
標題: 單片機小車尋跡（尋黑線）源程序
#include<reg52.h>
unsigned char pow_left_var = 170; //左電機占空比為0~170 0最快
unsigned char pow_right_var = 170;//右電機占空比為0~170 0最快
unsigned char pow_t;//周期

#define uint unsigned int
#define uchar unsigned char

/*獨立按鍵位定義*/
//sbit key_s3 = P3^1;
//sbit key_s4 = P3^2;
sbit IN1 = P1^2; //為1 左電機反轉
sbit IN2 = P1^3; //為1 左電機正轉
sbit IN3 = P1^6; //為1 右電機正轉
sbit IN4 = P1^7; //為1 右電機反轉
sbit EN1 = P1^4; //為1 左電機使能
sbit EN2 = P1^5; //為1 右電機使能
sbit left_led1 = P3^3; //左尋跡信號為1時識別到黑線為0沒有識別到黑線
sbit right_led1 = P3^2;//右尋跡信號為1時識別到黑線為0沒有識別到黑線

#define left_motor_en    EN1 = 1 //左電機使能
#define left_motor_stops EN1 = 0 //停止左電機使能
#define right_motor_en    EN1 = 1 //右電機使能
#define right_motor_stops  EN1 = 0 //停止右電機使能

#define left_motor_go    IN1 = 0 , IN2 = 1       //左電機正轉
#define left_motor_back IN1 = 1 , IN2 = 0       //左電機反轉
#define right_motor_go IN4 = 0 , IN3 = 1       //右電機正轉
#define right_motor_back  IN4 = 1       IN3 = 0       //右電機反轉

void left() //左轉
{
left_motor_stops;//停止左電機使能
right_motor_en;       //右電機使能
right_motor_go;       //右電機正轉
}

void right() //右轉
{
right_motor_stops;//停止右電機使能
left_motor_en;       //左電機使能
left_motor_go;       //左電機正轉
}

void forward() //小車前進
{
right_motor_en;       //右電機使能
left_motor_en;       //左電機使能
right_motor_go;       //右電機正轉
left_motor_go;       //左電機正轉

}
void dsqzd()//定時器初始化
{
EA = 1; //開總中斷
TR0 = 1;//允許啟動定時器0中斷
TMOD = 0X02;//8位重裝模式
TH0 = 240;  //11.0892M晶振下占空比為256 頻率100HZ
TL0 = 240;
ET0 = 1;//啟動定時器0
}

void timer0() interrupt 1 //定時器0中斷
{
pow_t++;
if(pow_t == 255)
{
      pow_t = EN1 = EN2 = 0;       //左右使能為0
      }
      if(pow_left_var == pow_t)
      {
         EN1 = 1;  //左電機使能
      }
      if(pow_right_var == pow_t)
      {
         EN2 = 1; //右電機使能
      }
}

void main()
{
while(1)
{
   if(left_led1 == 1 && right_led1 == 1) //左右都在黑線上
         forward();//前進
   if(left_led1 == 1 && right_led1 == 0) //右邊在黑線上
         left();       //左轉
      if(left_led1 == 0 && right_led1 == 1) //左邊在黑線上
         right(); //右轉
}
}

歡迎光臨 (http://www.zg4o1577.cn/bbs/)