|
Altium Designer畫的原理圖和PCB圖如下:(51hei附件中可下載工程文件)
#include<reg52.h>
#define uchar unsigned char
#define uint unsigned int
uint t,t1,biao=0,biao1=0;
uint zuo,you,zhong;
sbit A1=P2^0;//電機一 正極
sbit A2=P2^1;//電機一 負極
sbit B1=P2^2; //電機二 正極
sbit B2=P2^3;//電機二 負極
sbit AX=P2^4; //電機一 使能
sbit BX=P2^5;//電機二 使能
sbit jc1=P0^0;
sbit jc2=P0^1;
sbit jc3=P0^2;
sbit bz=P3^2;
void delay(uint x)
{
uint a,b;
for(a=x;a>0;a--)
for(b=110;b>0;b--);
}
void init()
{
EA=1;
ET1=1;
TMOD=0x10;
TH1=(65536-50000)/256;
TL1=(65536-50000)%256;
AX=0;BX=0;
A1=0;A2=0;
B1=0;B2=0;
zuo=0,you=0;zhong=0;
}
/***************循跡************/
void zz()//左旋轉
{
AX=0;BX=1;
A1=0;A2=0;
B1=1;B2=0;
}
void yz()//右旋轉
{
AX=1;BX=0;
A1=1;A2=0;
B1=0;B2=0;
}
void qj()//前進
{
AX=1;BX=1;
A1=1;A2=0;
B1=1;B2=0;
}
void ht()//后退
{
AX=1;BX=1;
A1=0;A2=1;
B1=0;B2=1;
}
void ydz()//原地轉
{
AX=1;BX=1;
A1=0;A2=1;
B1=1;B2=0;
}
/*void tz()//停止
{
AX=0;BX=0;
A1=0;A2=0;
B1=0;B2=0;
} */
/**********運行*****************/
void xj()
{
if(jc2==0) //沒有偏離軌道
{
qj();
biao=0;
zhong=1;zuo=0;you=0;
}
else if(jc1==0) //向左偏離軌道
{
yz();
}
else if(jc3==0) //向右偏離軌道
{
zz();
biao=0;
zhong=0;zuo=1;you=0;
}
else
{
if(jc1==1)
{
if(jc2==1)
{
if(jc3==1)
{
ht();
}
}
}
}
}
/***********主循跡*********/
void zxj()
{
if(biao==0)
{
xj();
}
else
{
xj();
if(biao==1)
{
ydz();
delay(1400);
biao=0;
}
else
biao=0;
}
}
/***************臂障**************/
void bz1()
{
if(bz==0)
{
delay(500);
if(bz==0)
{
biao1=1;
TR1=1;
TH1=(65536-50000)/256;
TL1=(65536-50000)%256;
t=0;
t1=0;
}
}
else
biao1=0;
}
/***********主函數***************/
void main()
{
init();
biao=0;biao1=0;
while(1)
{
if(biao1==0)
{
zxj();
bz1();
}
else
{ if(t1==0)
zz();
}
}
}
void as() interrupt 3
{
TH1=(65536-50000)/256;
TL1=(65536-50000)%256;
t++;
if(t==10)
{
t=0;
t1++;
}
}
|
-
小車底盤.jpg
(11.78 KB, 下載次數: 71)
下載附件
2019-8-8 08:50 上傳
-
多功能小車.jpg
(45.3 KB, 下載次數: 53)
下載附件
2019-8-8 08:50 上傳
-
實物參考照片1.jpg
(38.13 KB, 下載次數: 56)
下載附件
2019-8-8 08:49 上傳
-
0.png
(27.95 KB, 下載次數: 66)
下載附件
2019-8-8 15:59 上傳
-
0.png
(9.11 KB, 下載次數: 72)
下載附件
2019-8-8 15:59 上傳
-
0.png
(4.9 KB, 下載次數: 54)
下載附件
2019-8-8 15:59 上傳
-
-
原理圖和PCB.7z
2019-8-8 16:00 上傳
點擊文件名下載附件
下載積分: 黑幣 -5
404.61 KB, 下載次數: 92, 下載積分: 黑幣 -5
-
-
元件清單.rar
2019-8-8 08:51 上傳
點擊文件名下載附件
下載積分: 黑幣 -5
20.26 KB, 下載次數: 38, 下載積分: 黑幣 -5
-
-
源程序.rar
2019-8-8 08:52 上傳
點擊文件名下載附件
下載積分: 黑幣 -5
20.14 KB, 下載次數: 46, 下載積分: 黑幣 -5
|