履帶避障智能小車制作附單片機(jī)程序

ID:1091382 · 發(fā)表于 2024-3-13 13:42

履帶避障智能小車，51單片機(jī)智能小車，三路避障紅外傳感更精控。原先鋁底車板軸距不能滿足履帶。鋁易鉆孔，經(jīng)過(guò)電鉆打孔安裝螺絲與電機(jī)后完美解決此類問(wèn)題。只需兩個(gè)后驅(qū)電機(jī)驅(qū)動(dòng)即可，省電，爬坡能力強(qiáng)，避障。另外兩個(gè)前電機(jī)把里面咬合齒輪拆掉就順暢了，不用再接電，畢竟履帶聯(lián)動(dòng)嘛。有配套避障代碼。

制作圖片：

單片機(jī)避障程序;
#include<reg51.h>
#define uint unsigned int
#define uchar unsigned char
  sbit z=P0^0;//定義紅外避障檢測(cè)端口
  sbit q=P0^4;
  sbit y=P2^0;
  sbit mz=P1^6;//定義電機(jī)Mz電平輸出端口
  sbit IN1=P1^3;
  sbit IN2=P1^2;
  sbit my=P1^7;//定義電機(jī)My電平輸出端口
  sbit IN3=P3^6;
  sbit IN4=P3^5;
  void delayms(uint);//聲明延時(shí)函數(shù)

  main()//主函數(shù)
  {
uint i=0;//初始值設(shè)定
mz=1;
my=1;
while(1)//無(wú)限循環(huán)
{
if(z==0&&q==1&&y==1)//表示z方有障礙物  進(jìn)行y轉(zhuǎn)向
  {
for(i=0;i<5;i++)
{
mz=1;
IN1=1;
IN2=0;
my=0;
delayms(100);//狀態(tài)保持100ms
mz=0;
my=0;
delayms(2);//狀態(tài)保持2ms
}
  }
if(z==1&&q==0&&y==1)//表示前方有障礙物  進(jìn)行y轉(zhuǎn)向
  {
for(i=0;i<5;i++)
{
mz=1;
IN1=1;
IN2=0;
my=0;
delayms(100);//狀態(tài)保持100ms
mz=0;
my=0;
delayms(2);//狀態(tài)保持2ms
}
  }
if(z==1&&q==1&&y==0)//表示y方有障礙物  進(jìn)行z轉(zhuǎn)向
  {
for(i=0;i<5;i++)
{
mz=0;
my=1;
IN3=1;
IN4=0;
delayms(100);//狀態(tài)保持100ms
mz=0;
my=0;
delayms(2);//狀態(tài)保持2ms
}
  }
  if(z==0&&q==0&&y==1)//表示z前方有障礙物  進(jìn)行y轉(zhuǎn)向
  {
for(i=0;i<5;i++)
{
mz=1;
IN1=1;
IN2=0;
my=0;
delayms(100);//狀態(tài)保持100ms
mz=0;
my=0;
delayms(2);//狀態(tài)保持2ms
}
  }
if(z==1&&q==0&&y==0)//表示y前方有障礙物  進(jìn)行z轉(zhuǎn)向
  {
for(i=0;i<5;i++)
{
mz=0;
my=1;
IN3=1;
IN4=0;
delayms(100);//狀態(tài)保持100ms
mz=0;
my=0;
delayms(2);//狀態(tài)保持2ms
}
  }
if(z==0&&q==0&&y==0)//表示前有障礙物  先停下進(jìn)行后退移動(dòng)
  {
for(i=0;i<5;i++)
{
mz=0;
my=0;
delayms(100);//狀態(tài)保持100ms
mz=1;
IN1=0;
IN2=1;
my=1;
IN3=0;
IN4=1;
delayms(2);//狀態(tài)保持2ms
}
  }
  if(z==1&&q==1&&y==1)//表示前方無(wú)障礙物  停止
  {
mz=0;
my=0;
delayms(2);//狀態(tài)保持2ms
  }
}
}
void delayms(uint xms)
{
      uint i,j;
      for(i=xms;i>0;i--)
            for(j=110;j>0;j--);
}

原理圖: 無(wú)
仿真: 無(wú)
代碼: 可下載的程序附件：

代碼.zip (66.14 KB, 下載次數(shù): 12)