|
|
20黑幣
不才想利用單片機(jī)控制光電開關(guān)傳感器，當(dāng)光電開關(guān)傳感器檢測到障礙物時就走xx毫秒。但現(xiàn)在的問題是一接通電源左電機(jī)動而右電機(jī)不動，檢測到障礙物則相反（即右電機(jī)動左電機(jī)不動），思考良久仍然找不出問題所在，拜托各位前輩慷慨相助，不吝賜教 。單片機(jī)程序如下：
#include "reg52.h"
/*電機(jī)驅(qū)動IO定義*/
sbit IN1 = P1^0; //為1 左電機(jī)反轉(zhuǎn)
sbit IN2 = P1^1; //為1 左電機(jī)正轉(zhuǎn)
sbit IN3 = P1^2; //為1 右電機(jī)正轉(zhuǎn)
sbit IN4 = P1^3; //為1 右電機(jī)反轉(zhuǎn)
sbit EN1 = P1^4; //為1 左電機(jī)使能
sbit EN2 = P1^5; //為1 右電機(jī)使能
sbit left_led2 = P3^4;//左避障信號 為0 識別障礙物 為1沒有識別到障礙物
sbit right_led2 = P3^5;//右避障信號 為0 識別障礙物 為1沒有識別到障礙物
#define left_motor_en EN1 = 1 //左電機(jī)使能
#define right_motor_en EN2 = 1 //右電機(jī)使能
#define left_motor_stops IN1 = 0, IN2 = 0//左電機(jī)停止
#define right_motor_stops IN3 = 0, IN4 = 0//右電機(jī)停止
#define left_motor_go IN1 = 0, IN2 = 1//左電機(jī)正傳
#define left_motor_back IN1 = 1, IN2 = 0//左電機(jī)反轉(zhuǎn)
#define right_motor_go IN3 = 1, IN4 = 0//右電機(jī)正傳
#define right_motor_back IN3 = 0, IN4 = 1//右電機(jī)反轉(zhuǎn)
unsigned char pwm_left_val = 100;//左電機(jī)占空比值 取值范圍0-170，0最快
unsigned char pwm_right_val = 100;//右電機(jī)占空比值取值范圍0-170 ,0最快
unsigned char pwm_t;//周期
void delay(unsigned int z)//毫秒級延時
{
unsigned int x,y;
for(x = z; x > 0; x--)
for(y = 114; y > 0 ; y--);
}
/*小車前進(jìn)*/
void forward()
{
left_motor_go; //左電機(jī)前進(jìn)
right_motor_go; //右電機(jī)前進(jìn)
}
//定時器0中斷
void timer0() interrupt 1
{
pwm_t++;//周期計時加
if(pwm_t == 255)
pwm_t = EN1 = EN2 = 0;
if(pwm_left_val == pwm_t)//左電機(jī)占空比
EN1 = 1;
if(pwm_right_val == pwm_t)//右電機(jī)占空比
EN2 = 1;
}
void main()
{
TMOD |= 0x02;//8位自動重裝模塊
TH0 = 220;
TL0 = 220;//11.0592M晶振下占空比最大比值是256,輸出100HZ
TR0 = 1;//啟動定時器0
ET0 = 1;//允許定時器0中斷
EA = 1;//總中斷允許
while(1)
{
//為0 識別障礙物 為1沒有識別到障礙物
if(left_led2 == 0 || right_led2 == 1)//小車右側(cè)識別到障礙物，前進(jìn)
{
forward();//前進(jìn)
delay(540);
left_motor_stops;
right_motor_stops;//停止
}
}
}
|
|
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
