|
|
附上程序
#include "reg52.h"
#include "intrins.h"
typedef unsigned char BYTE;
typedef unsigned int WORD;
#define FOSC 12000000L //系統頻率
#define BAUD 115200 //串口波特率
#define uint unsigned int
#define uchar unsigned char
#define Busy 0x80 //用于檢測LCM狀態字中的Busy標識
//////液晶屏數據口///////
sbit LCM_RS =P2^0;//定義液晶屏信號引腳
sbit LCM_RW =P2^1;
sbit LCM_E =P2^2;
#define LCM_Data P0//液晶數端口
unsigned char code uctech[] = {"0123456789ABCDEF:"};
sfr AUXR = 0x8e; //輔助寄存器
#define T1MS (65536-FOSC/8000) //1000MS模式
sbit ONA =P2^3;//電機1A
sbit ONB =P2^4;//電機1B
sbit ONC =P2^6;//電機2A
sbit OND =P2^7;//電機2B
sbit Echo1 =P3^2;//超聲波數據
sbit Trig1 =P2^5;//超聲波啟動
void delay(unsigned int z)//延時
{
unsigned int x,y;
for(x=z;x>0;x--)
for(y=110;y>0;y--);
}
//1ms延時
void Delay5Ms(void)
{
delay(5);
}
void WriteDataLCM(unsigned char WDLCM)
{
//ReadStatusLCM(); //檢測忙
LCM_RS = 1;
LCM_Data = WDLCM;
Delay5Ms();
LCM_RW = 0;
LCM_E = 1; //若晶振速度太高可以在這后加小的延時
Delay5Ms();
LCM_E = 0; //延時
}
//寫指令
void WriteCommandLCM(unsigned char WCLCM,BuysC) //BuysC為0時忽略忙檢測
{
//if (BuysC) ReadStatusLCM(); //根據需要檢測忙
LCM_RS = 0;
LCM_Data = WCLCM;
Delay5Ms();
LCM_RW = 0;
LCM_E = 1;
Delay5Ms();
LCM_E = 0;
}
#if 0
//讀數據
unsigned char ReadDataLCM(void)
{
LCM_RS = 1;
LCM_RW = 1;
LCM_E = 0;
LCM_E = 0;
LCM_E = 1;
return(LCM_Data);
}
//讀狀態
unsigned char ReadStatusLCM(void)
{
LCM_Data = ~0xFF;
LCM_RS = 0;
LCM_RW = 1;
LCM_E = 0;
LCM_E = 0;
LCM_E = 1;
while (LCM_Data & Busy); //檢測忙信號
return(LCM_Data);
}
#endif
void LCMInit(uchar i) //LCM初始化
{
LCM_Data = 0;
WriteCommandLCM(0x38,0); //三次顯示模式設置，不檢測忙信號
Delay5Ms();
WriteCommandLCM(0x38,0);
Delay5Ms();
WriteCommandLCM(0x38,0);
Delay5Ms();
WriteCommandLCM(0x38,1); //顯示模式設置,開始要求每次檢測忙信號
WriteCommandLCM(0x08,1); //關閉顯示
WriteCommandLCM(0x01,1); //顯示清屏
WriteCommandLCM(0x06,1); // 顯示光標移動設置
WriteCommandLCM(i,1); // 顯示開及光標設置
}
void LCMInitc(uchar i)
{
WriteCommandLCM(0x06,0); //光標歸位
WriteCommandLCM(i,0); //關光標，閃爍
}
//按指定位置顯示一個字符
void DisplayOneChar(unsigned char X, unsigned char Y, unsigned char DData,uchar i)
{
Y &= 0x1;
X &= 0xF; //限制X不能大于15，Y不能大于1
if (Y) X |= 0x40; //當要顯示第二行時地址碼+0x40;
X |= 0x80; // 算出指令碼
WriteCommandLCM(X,0); //這里不檢測忙信號，發送地址碼
LCMInitc(i);
Delay5Ms();
LCMInitc(0x0c);
WriteDataLCM(DData);
}
//按指定位置顯示一串字符
void DisplayListChar(unsigned char X, unsigned char Y, unsigned char code *DData)
{
unsigned char ListLength;
ListLength = 0;
Y &= 0x1;
X &= 0xF; //限制X不能大于15，Y不能大于1
while (DData[ListLength]>0x20) //若到達字串尾則退出
{
if (X <= 0xF) //X坐標應小于0xF
{
DisplayOneChar(X, Y,DData[ListLength],0x0c); //顯示單個字符
ListLength++;
X++;
}
}
}
void tim0init()
{
//AUXR |= 0x80; //定時器0為1T模式
TMOD = 0x00; //設置定時器為模式0(16位自動重裝載)
TL0 = 0x66; //初始化計時值
TH0 = 0xfc;
TR0 = 1; //定時器0開始計時
ET0 = 1; //使能定時器0中斷
TMOD|=0x11; //設T1為方式1，GATE=1；
EA=1; //開啟總中斷
TH1=0;
TL1=0;
ET1=1; //允許T1中斷
TR1=0;
EA = 1;
}
WORD U16FLAG;
unsigned int time_c,Dista1;
unsigned char timeH,timeL;
bit succeed_flag;
/********************************************************/
void StartModule()
{
// unsigned int distance;
#if 1
Trig1=1; //啟動模塊
delay(1);
Trig1=0;
U16FLAG=58477;
while((!Echo1)&&U16FLAG++);
TR1=1; //開啟計數
U16FLAG=58477;
while((Echo1)&&U16FLAG++);
TR1=0;
time_c=TH1*256+TL1;
TH1=0;
TL1=0;
Dista1=(time_c*1.7)/100;//算出來是CM
delay(50);
#endif
}
void timer1() interrupt 3 using 1
{
TH0=0;
TL0=0; //中斷溢出標志
}
uint tim0[20];
//定時器中斷
void tm0_isr() interrupt 1 using 1
{
tim0[0]++;
if(Dista1>110)//加速正轉
{
tim0[3]=(Dista1-80);
tim0[2]=65536-FOSC/(tim0[3]*200);
TL0=tim0[2];
TH0=tim0[2]>>8;
switch(tim0[0])
{
case 1: ONA=0;ONB=1;ONC=1;OND=1;break;
case 2: ONA=1;ONB=0;ONC=1;OND=1;break;
case 3: ONA=1;ONB=1;ONC=0;OND=1;break;
case 4: ONA=1;ONB=1;ONC=1;OND=0;tim0[0]=0; break;
}
}
if(Dista1>80&&Dista1<140)//勻速正轉
{
tim0[2]=65536-FOSC/3000;
TL0=tim0[2];
TH0=tim0[2]>>8;
switch(tim0[0])
{
case 1: ONA=0;ONB=1;ONC=1;OND=1;break;
case 2: ONA=1;ONB=0;ONC=1;OND=1;break;
case 3: ONA=1;ONB=1;ONC=0;OND=1;break;
case 4: ONA=1;ONB=1;ONC=1;OND=0;tim0[0]=0; break;
}
}
else if(Dista1<=20)//加速反轉
{
tim0[3]=(50-Dista1) ;
tim0[2]=65536-FOSC/(tim0[3]*200);
TL0=tim0[2];
TH0=tim0[2]>>8;
switch(tim0[0])
{
case 1: ONA=1;ONB=1;ONC=0;OND=1;break;
case 2: ONA=1;ONB=0;ONC=1;OND=1;break;
case 3: ONA=0;ONB=1;ONC=1;OND=1;break;
case 4: ONA=1;ONB=1;ONC=1;OND=0;tim0[0]=0;break;
}
}
else if(Dista1<=50)//勻速反轉
{
tim0[2]=65536-FOSC/3000;
TL0=tim0[2];
TH0=tim0[2]>>8;
switch(tim0[0])
{
case 1: ONA=1;ONB=1;ONC=0;OND=1;break;
case 2: ONA=1;ONB=0;ONC=1;OND=1;break;
case 3: ONA=0;ONB=1;ONC=1;OND=1;break;
case 4: ONA=1;ONB=1;ONC=1;OND=0;tim0[0]=0;break;
}
}
else if(Dista1>50&&Dista1<80)//不轉
{
ONA=1;ONB=1;ONC=1;OND=1;
tim0[0]=0;
}
else if(Dista1>140)// 勻速轉
{
tim0[2]=65536-FOSC/6000;
TL0=tim0[2];
TH0=tim0[2]>>8;
switch(tim0[0])
{
case 1: ONA=0;ONB=1;ONC=1;OND=1;break;
case 2: ONA=1;ONB=0;ONC=1;OND=1;break;
case 3: ONA=1;ONB=1;ONC=0;OND=1;break;
case 4: ONA=1;ONB=1;ONC=1;OND=0;tim0[0]=0;break;
}
}
}
void main()
{
tim0init();
LCMInit(0x0c); //LCM初始化
Delay5Ms(); //延時片刻(可不要
DisplayListChar(8, 1,"C");//在指定,列顯示字符串
DisplayListChar(9, 1,"M");//在指定,列顯示字符串
while(1)
{
StartModule();
DisplayOneChar(4,1,uctech[Dista1/1000%10],0x0c);//顯示個位
DisplayOneChar(5,1,uctech[Dista1/100%10],0x0c);//顯示個位
DisplayOneChar(6,1,uctech[Dista1/10%10],0x0c);//顯示個位
DisplayOneChar(7,1,uctech[Dista1%10],0x0c);//顯示個位
}
}
|
|
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
