|
|
#include <reg52.h>
sbit Moto_RA=P1^6;
sbit Moto_RB=P1^5;
sbit Moto_LA=P1^4;
sbit Moto_LB=P1^3; //左右電機(jī)驅(qū)動(dòng)
/***********************************
*函數(shù)名稱：void Delay(unsigned char num)
*函數(shù)功能：延時(shí)
*參數(shù)說明：num 延時(shí)時(shí)間 數(shù)值最大255
*返回說明：無
*其它說明：不精準(zhǔn)延時(shí)
***********************************/
void Delay(unsigned char num)
{
unsigned int temp=0;
while(num--)
{
temp=2000;
while(temp--);
}
}
/***********************************
*函數(shù)名稱：void Car_Run(unsigned char dire)
*函數(shù)功能：行進(jìn)方向控制
*參數(shù)說明：dire 方向 0：停止 1：前 2：后 3：左 4：右
*返回說明：無
*其它說明：左右方向?yàn)樵剞D(zhuǎn)彎 【若想前進(jìn)中和后退中轉(zhuǎn)彎 需要與調(diào)速函數(shù)配合 使兩個(gè)車輪轉(zhuǎn)速不同】
***********************************/
void Car_Run(unsigned char dire)
{
switch (dire)
{
case 0: //停止
{
Moto_RA=0;
Moto_RB=0;
Moto_LA=0;
Moto_LB=0;
}break;
case 1: //前進(jìn)
{
Moto_RA=1;
Moto_RB=0;
Moto_LA=1;
Moto_LB=0;
}break;
case 2: //后退
{
Moto_RA=0;
Moto_RB=1;
Moto_LA=0;
Moto_LB=1;
}break;
case 3: //左轉(zhuǎn)
{
Moto_RA=1;
Moto_RB=0;
Moto_LA=0;
Moto_LB=1;
}break;
case 4: //右轉(zhuǎn)
{
Moto_RA=0;
Moto_RB=1;
Moto_LA=1;
Moto_LB=0;
}break;
default:break;
}
}
/***********************************
*函數(shù)名稱：void main(void)
*函數(shù)功能：程序入口
*參數(shù)說明：無
*返回說明：無
*其它說明：main函數(shù)有且只有一個(gè)
***********************************/
void main(void)
{
while(1)
{
Car_Run(1); //前進(jìn)
Delay(20);
Car_Run(2); //后退
Delay(20);
Car_Run(3); //左轉(zhuǎn)
Delay(20);
Car_Run(4); //右轉(zhuǎn)
Delay(20);
Car_Run(0); //停止
Delay(20);
}
}
|
評(píng)分
-
查看全部評(píng)分
|
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
