|
|
#include <REGX52.H>
#include <intrins.h>
#include <stdio.h>
#define uchar unsigned char
#define uint unsigned int
sbit SH_CP1 = P0^1;
sbit DS = P0^0;
sbit ST_CP1 = P0^2;
int distL,distR;
unsigned char code table[]={0x3F,0x06,0x5B,0x4F,0x66,0x6D,0x7D,0x07,0x7F,0x6F};
sbit TrigL = P2^4; // 超聲波模塊的Trig管腳
sbit EchoL = P2^5; // 超聲波模塊的Echo管腳
sbit TrigR = P2^6; // 超聲波模塊的Trig管腳
sbit EchoR = P2^7; // 超聲波模塊的Echo管腳
//============MAIN===============================
void Delay(unsigned int xms) //延時
{
unsigned char i, j;
while(xms--)
{
i = 2;
j = 199;
do
{
while (--j);
} while (--i);
}
}
void send_data_74hc595(uint data_74hc595) //傳送數據給74hc595
{
uchar a;
for(a = 0; a < 8; ++a)
{
DS = (data_74hc595 << a) & 0x80; //從高位開始傳輸
SH_CP1 = 0;
_nop_();
_nop_();
SH_CP1 = 1;
}
}
void show_74hc595() //數據顯示
{
ST_CP1 = 0;
_nop_();
_nop_();
ST_CP1 = 1;
}
void Nixie()
{
switch(distR)
{
case 1:send_data_74hc595(table[1]);show_74hc595();break;
case 2:send_data_74hc595(table[2]);show_74hc595();break;
case 3:send_data_74hc595(table[3]);show_74hc595();break;
case 4:send_data_74hc595(table[4]);show_74hc595();break;
case 5:send_data_74hc595(table[5]);show_74hc595();break;
case 6:send_data_74hc595(table[6]);show_74hc595();break;
case 7:send_data_74hc595(table[7]);show_74hc595();break;
case 8:send_data_74hc595(table[8]);show_74hc595();break;
case 9:send_data_74hc595(table[9]);show_74hc595();break;
}
switch(distL)
{
case 1:send_data_74hc595(table[1]);show_74hc595();break;
case 2:send_data_74hc595(table[2]);show_74hc595();break;
case 3:send_data_74hc595(table[3]);show_74hc595();break;
case 4:send_data_74hc595(table[4]);show_74hc595();break;
case 5:send_data_74hc595(table[5]);show_74hc595();break;
case 6:send_data_74hc595(table[6]);show_74hc595();break;
case 7:send_data_74hc595(table[7]);show_74hc595();break;
case 8:send_data_74hc595(table[8]);show_74hc595();break;
case 9:send_data_74hc595(table[9]);show_74hc595();break;
} }
//模塊程序
uint GetDistanceL(void)
{
uint s;
TH0 = 0;
TL0 = 0;
TrigL=1; //800MS 啟動一次模塊
Delay(0.001);
TrigL=0;
while(!EchoL); //當RX為零時等待
TR0=1; //開啟計數
while(EchoL); //當RX為1計數并等待
TR0=0; //關閉計數
//timeL=TH0*256+TL0;
// timeL *= 12/11.0592;
//s=(timeL*1.7)/100; //算出來是CM
s=((TH0*256+TL0)*0.034)/2;
return s;
}
uint GetDistanceR(void)
{
uint s;
TH0 = 0;
TL0 = 0;
TrigR=1; //800MS 啟動一次模塊
Delay(0.001);
TrigR=0;
while(!EchoR); //當RX為零時等待
TR0=1; //開啟計數
while(EchoR); //當RX為1計數并等待
TR0=0; //關閉計數
s=((TH0*256+TL0)*0.034)/2;
return s;
}
void main()
{
TMOD = 0x02;
ET0=0;
EA =1; // 選擇定時器0，并且確定是工作方式1（為了超聲波模塊測量距離計時用的）
TrigL=0; // 初始化觸發引腳為低電平
TrigR=0;
while(1)
{
//===========Ultrasonic measurement===========
//left
distL = GetDistanceL();
//right
distR = GetDistanceR();
Nixie();
}//end of while
}//end of main
|
|
QQ好友和群
QQ空間
騰訊微博
騰訊朋友
收藏
淘帖
頂
踩
