先上代码
#include <REGX52.H>
#include <INTRINS.H>
#include "LCD1602.h"
sbit motor=P2^1;
sbit dismotor=P2^0;
sbit motor2=P2^4;
sbit dismotor2=P2^5;
sbit trig=P1^3;
sbit echo=P1^2;
sbit trig1=P1^5;
sbit echo1=P1^4;
sbit trig2=P1^7;
sbit echo2=P1^6;
void Delay10ms() //@11.0592MHz
{
unsigned char i, j;
i = 108;
j = 145;
do
{
while (--j);
} while (--i);
}
void Delay50ms() //@11.0592MHz
{
unsigned char i, j, k;
_nop_();
_nop_();
i = 3;
j = 26;
k = 223;
do
{
do
{
while (--k);
} while (--j);
} while (--i);
}
void Timer0Init(void) //1毫秒@11.0592MHz
{
TMOD &= 0xF0; //设置定时器模式
TMOD |= 0x01; //设置定时器模式
TL0 = 0xA4; //设置定时初值
TH0 = 0xFF; //设置定时初值
TF0 = 0; //清除TF0标志
TR0 = 1; //定时器0开始计时
ET0=1;
EA=1;
PT0=0;
}
void Delay20us() //@11.0592MHz
{
unsigned char i;
_nop_();
_nop_();
_nop_();
i =