#include<reg52.h>
#define uchar unsigned char
#define uint unsigned int
sbit IN1 = P1^0; //P20與電機驅動IN1相連
sbit IN2 = P1^1; //P21與電機驅動IN2相連
sbit IN3 = P1^2; //P22與電機驅動IN3相連
sbit IN4 = P1^3; //P23與電機驅動IN4相連
//P00左邊模塊
sbit D1 = P0^0; //P01中間模塊
sbit D3 = P0^3; //P02右邊模塊
sbit D6 = P0^6;
uint temp;
void left_zheng(void);
void left_fan(void);
void right_zheng(void);
void right_fan(void);
void ting(void);
void go(void);
void back(void);
void delayms(uint z);
void main(void)
{
while(1)
{
// temp = P0&0xff;
if(D1 == 0 && D3 == 0 && D6 == 0)
{
ting();
}
if(D1 == 0 && D3 == 0 && D6 == 1)
{
left_zheng();
}
if(D1 == 0 && D3 == 1 && D6 == 0)
{
go();
}
if(D1 == 0 && D3 == 1 && D6 == 1)
{
left_zheng();
}
if(D1 == 1 && D3 == 0 && D6 == 0)
{
right_zheng();
}
if(D1 == 1 && D3 == 0 && D6 == 1)
{
go();
}
if(D1 == 1 && D3 == 1 && D6 == 0)
{
right_zheng();
}
if(D1 == 1 && D3 == 1 && D6 == 1)
{
ting();
}
/* switch(temp)
{
case 0x00: ting(); break;
case 0x01: right_zheng(); break;
case 0x02: go(); break;
case 0x03: go(); break;
case 0x04: left_zheng(); break;
case 0x05: go(); break;
case 0x06: go(); break;
case 0x07: ting(); break;
default: break;
} */
}
}
void left_zheng(void) //IN1 = 1, IN2 = 0;反轉
{ //IN1 = 0, IN2 = 1;正轉
IN1 = 0; //IN3 = 1, IN4 = 0;反轉
IN2 = 0; //IN3 = 0, IN4 = 1;正轉
IN3 = 0;
IN4 = 1;
delayms(100);
}
void left_fan(void)
{
IN1 = 0;
IN2 = 0;
IN3 = 1;
IN4 = 0;
delayms(50);
}
void right_zheng(void)
{
IN1 = 0;
IN2 = 1;
IN3 = 0; //IN1 = 0, IN2 = 0;制動
IN4 = 0;
delayms(100); //IN1 = 1, IN2 = 1;制動
}
void right_fan(void)
{
IN1 = 1;
IN2 = 0;
IN3 = 0;
IN4 = 0;
delayms(50);
}
void go(void)
{
IN1 = 0;
IN2 = 1;
IN3 = 0;
IN4 = 1;
delayms(30);
}
void back(void)
{
IN1 = 1;
IN2 = 0;
IN3 = 1;
IN4 = 0;
delayms(50);
}
void ting(void)
{
IN1 = 0;
IN2 = 0;
IN3 = 0;
IN4 = 0;
delayms(50);
}
void delayms(uint z)
{
uint i,j;
for(i = 0; i < z; i++)
for(j = 0; j < 110; j++);
}
|
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
