|
我是想通過提示判斷斷xy軸上的數(shù)據(jù)來實(shí)現(xiàn)小車9中運(yùn)動狀態(tài) 但是感覺好像不行
下面的是可以的 但是只能實(shí)現(xiàn)前后左右停
單片機(jī)源程序如下:
#include <REGX52.H>
#include <INTRINS.H>
sbit SCL=P1^0; //IIC時(shí)鐘引腳定義
sbit SDA=P1^1; //IIC數(shù)據(jù)引腳定義
unsigned char BUF[6]; //接收數(shù)據(jù)緩存區(qū)
int XYZ_data[3];
void Init_ADXL345(void); //初始化ADXL345
void Single_Write_ADXL345(unsigned char REG_Address,unsigned char REG_data); //單個(gè)寫入數(shù)據(jù)
void Multiple_Read_ADXL345(); //連續(xù)的讀取內(nèi)部寄存器數(shù)據(jù)
void Delay5us();
void Delay(unsigned int a);
void ADXL345_Start();
void ADXL345_Stop();
void ADXL345_SendACK(bit ack);
bit ADXL345_RecvACK();
void ADXL345_SendByte(unsigned char dat);
unsigned char ADXL345_RecvByte();
void Send(unsigned char CMD);
void UartInit();
void Data_Process();
void direction_judge();
bit flag;
unsigned char CMD1,CMD2;
void Delay(unsigned int a) //@11.0592MHz
{
while(a--)
{
unsigned char i, j;
_nop_();
i = 2;
j = 199;
do
{
while (--j);
} while (--i);
}
}
void Delay5us() //@11.0592MHz
{
}
/**************************************
起始信號
**************************************/
void ADXL345_Start()
{
SDA = 1; //拉高數(shù)據(jù)線
SCL = 1; //拉高時(shí)鐘線
Delay5us(); //延時(shí)
SDA = 0; //產(chǎn)生下降沿
Delay5us(); //延時(shí)
SCL = 0; //拉低時(shí)鐘線
}
/**************************************
停止信號
**************************************/
void ADXL345_Stop()
{
SDA = 0; //拉低數(shù)據(jù)線
SCL = 1; //拉高時(shí)鐘線
Delay5us(); //延時(shí)
SDA = 1; //產(chǎn)生上升沿
Delay5us(); //延時(shí)
}
/**************************************
發(fā)送應(yīng)答信號
入口參數(shù):ack (0:ACK 1:NAK)
**************************************/
void ADXL345_SendACK(bit ack)
{
SDA = ack; //寫應(yīng)答信號
SCL = 1; //拉高時(shí)鐘線
Delay5us(); //延時(shí)
SCL = 0; //拉低時(shí)鐘線
Delay5us(); //延時(shí)
}
/**************************************
接收應(yīng)答信號
**************************************/
bit ADXL345_RecvACK()
{
SCL = 1; //拉高時(shí)鐘線
Delay5us(); //延時(shí)
flag = SDA; //讀應(yīng)答信號
SCL = 0; //拉低時(shí)鐘線
Delay5us(); //延時(shí)
return flag;
}
/**************************************
向IIC總線發(fā)送一個(gè)字節(jié)數(shù)據(jù)
**************************************/
void ADXL345_SendByte(unsigned char dat)
{
unsigned char i;
for (i=0; i<8; i++) //8位計(jì)數(shù)器
{
SDA=dat&0x80;
SCL = 1; //拉高時(shí)鐘線
Delay5us(); //延時(shí)
SCL = 0; //拉低時(shí)鐘線
Delay5us(); //延時(shí)
dat <<= 1;
}
ADXL345_RecvACK();
}
//從IIC總線接收一個(gè)字節(jié)數(shù)據(jù)
unsigned char ADXL345_RecvByte()
{
unsigned char i;
unsigned char dat = 0;
SDA = 1; //使能內(nèi)部上拉,準(zhǔn)備讀取數(shù)據(jù),
for (i=0; i<8; i++) //8位計(jì)數(shù)器
{
dat <<= 1;
SCL = 1; //拉高時(shí)鐘線
Delay5us(); //延時(shí)
dat |= SDA; //讀數(shù)據(jù)
SCL = 0; //拉低時(shí)鐘線
Delay5us(); //延時(shí)
}
return dat;
}
//******單字節(jié)寫入*******************************************
void Single_Write_ADXL345(unsigned char REG_Address,unsigned char REG_data)
{
ADXL345_Start(); //起始信號
ADXL345_SendByte(0xA6); //發(fā)送設(shè)備地址
ADXL345_SendByte(REG_Address); //內(nèi)部寄存器地址
ADXL345_SendByte(REG_data); //內(nèi)部寄存器數(shù)據(jù)
ADXL345_Stop(); //發(fā)送停止信號
}
//連續(xù)讀出ADXL345內(nèi)部加速度數(shù)據(jù),地址范圍0x32~0x37
void Multiple_read_ADXL345(void)
{
unsigned int i;
ADXL345_Start(); //起始信號
ADXL345_SendByte(0xA6); //發(fā)送設(shè)備地址+寫信號
ADXL345_SendByte(0x32); //發(fā)送存儲單元地址,從0x32開始
ADXL345_Start(); //起始信號
ADXL345_SendByte(0xA7); //發(fā)送設(shè)備地址+讀信號
for (i=0; i<6; i++) //連續(xù)讀取6個(gè)地址數(shù)據(jù),存儲中BUF
{
BUF[ i] = ADXL345_RecvByte(); //BUF[0]存儲0x32地址中的數(shù)據(jù)
if (i == 5){ADXL345_SendACK(1);}//最后一個(gè)數(shù)據(jù)需要回NOACK
else ADXL345_SendACK(0); //回應(yīng)ACK
}
ADXL345_Stop(); //停止信號
Delay(5);
}
//初始化ADXL345,根據(jù)需要請參考pdf進(jìn)行修改************************
void Init_ADXL345()
{
Single_Write_ADXL345(0x31,0x0B); //測量范圍,正負(fù)16g,13位模式
Single_Write_ADXL345(0x2C,0x08); //速率設(shè)定為12.5 參考pdf13頁
Single_Write_ADXL345(0x2D,0x08); //選擇電源模式 參考pdf24頁
Single_Write_ADXL345(0x2E,0x80); //使能 DATA_READY 中斷
Single_Write_ADXL345(0x1E,0x00); //X 偏移量 根據(jù)測試傳感器的狀態(tài)寫入pdf29頁
Single_Write_ADXL345(0x1F,0x00); //Y 偏移量 根據(jù)測試傳感器的狀態(tài)寫入pdf29頁
Single_Write_ADXL345(0x20,0x05); //Z 偏移量 根據(jù)測試傳感器的狀態(tài)寫入pdf29頁
}
void UartInit() //9600bps@11.0592MHz
{
TMOD=0X20;
TH1=0XFD;
TL1=0XFD;
TR1=1;
SM0=0;
SM1=1;
EA=1;
ES=1;
}
void Send(unsigned char JIE)
{
SBUF=JIE;
while(!TI);
TI=0;
}
void Data_Process()
{
XYZ_data[0]=(BUF[1]<<8)+BUF[0];
XYZ_data[1]=(BUF[3]<<8)+BUF[2];
if(XYZ_data[0]<(-100))CMD1='4';
else if(XYZ_data[0]>100)CMD1='3';
else CMD1='9';
if(XYZ_data[1]<(-100))CMD2='2';
else if(XYZ_data[1]>100)CMD2='1';
else CMD2='9';
}
void direction_judge()
{
if(CMD1=='4'||CMD1=='3')
{Send(CMD1);}
else Send(CMD2);
}
//******主程序********
void main()
{
Delay(500);
UartInit();
Init_ADXL345();//初始化ADXL345
Delay(150);
while(1) //循環(huán)
{
Multiple_Read_ADXL345(); //連續(xù)讀出數(shù)據(jù),存儲在BUF中
Data_Process();
direction_judge();
Delay(500);
}
}
下面的是不可以的 我測試了下小車不可以動
#include <REGX52.H>
#include <INTRINS.H>
sbit SCL=P1^0; //IIC時(shí)鐘引腳定義
sbit SDA=P1^1; //IIC數(shù)據(jù)引腳定義
unsigned char BUF[6]; //接收數(shù)據(jù)緩存區(qū)
int XYZ_data[3];
void Init_ADXL345(void); //初始化ADXL345
void Single_Write_ADXL345(unsigned char REG_Address,unsigned char REG_data); //單個(gè)寫入數(shù)據(jù)
void Multiple_Read_ADXL345(); //連續(xù)的讀取內(nèi)部寄存器數(shù)據(jù)
void Delay5us();
void Delay(unsigned int a);
void ADXL345_Start();
void ADXL345_Stop();
void ADXL345_SendACK(bit ack);
bit ADXL345_RecvACK();
void ADXL345_SendByte(unsigned char dat);
unsigned char ADXL345_RecvByte();
void Send(char JIE);
void UartInit();
bit flag;
unsigned char CMD1,CMD2;
void Delay(unsigned int a) //@11.0592MHz
{
while(a--)
{
unsigned char i, j;
_nop_();
i = 2;
j = 199;
do
{
while (--j);
} while (--i);
}
}
void Delay5us() //@11.0592MHz
{
}
/**************************************
起始信號
**************************************/
void ADXL345_Start()
{
SDA = 1; //拉高數(shù)據(jù)線
SCL = 1; //拉高時(shí)鐘線
Delay5us(); //延時(shí)
SDA = 0; //產(chǎn)生下降沿
Delay5us(); //延時(shí)
SCL = 0; //拉低時(shí)鐘線
}
/**************************************
停止信號
**************************************/
void ADXL345_Stop()
{
SDA = 0; //拉低數(shù)據(jù)線
SCL = 1; //拉高時(shí)鐘線
Delay5us(); //延時(shí)
SDA = 1; //產(chǎn)生上升沿
Delay5us(); //延時(shí)
}
/**************************************
發(fā)送應(yīng)答信號
入口參數(shù):ack (0:ACK 1:NAK)
**************************************/
void ADXL345_SendACK(bit ack)
{
SDA = ack; //寫應(yīng)答信號
SCL = 1; //拉高時(shí)鐘線
Delay5us(); //延時(shí)
SCL = 0; //拉低時(shí)鐘線
Delay5us(); //延時(shí)
}
/**************************************
接收應(yīng)答信號
**************************************/
bit ADXL345_RecvACK()
{
SCL = 1; //拉高時(shí)鐘線
Delay5us(); //延時(shí)
flag = SDA; //讀應(yīng)答信號
SCL = 0; //拉低時(shí)鐘線
Delay5us(); //延時(shí)
return flag;
}
/**************************************
向IIC總線發(fā)送一個(gè)字節(jié)數(shù)據(jù)
**************************************/
void ADXL345_SendByte(unsigned char dat)
{
unsigned char i;
for (i=0; i<8; i++) //8位計(jì)數(shù)器
{
SDA=dat&0x80;
SCL = 1; //拉高時(shí)鐘線
Delay5us(); //延時(shí)
SCL = 0; //拉低時(shí)鐘線
Delay5us(); //延時(shí)
dat <<= 1;
}
ADXL345_RecvACK();
}
//從IIC總線接收一個(gè)字節(jié)數(shù)據(jù)
unsigned char ADXL345_RecvByte()
{
unsigned char i;
unsigned char dat = 0;
SDA = 1; //使能內(nèi)部上拉,準(zhǔn)備讀取數(shù)據(jù),
for (i=0; i<8; i++) //8位計(jì)數(shù)器
{
dat <<= 1;
SCL = 1; //拉高時(shí)鐘線
Delay5us(); //延時(shí)
dat |= SDA; //讀數(shù)據(jù)
SCL = 0; //拉低時(shí)鐘線
Delay5us(); //延時(shí)
}
return dat;
}
//******單字節(jié)寫入*******************************************
void Single_Write_ADXL345(unsigned char REG_Address,unsigned char REG_data)
{
ADXL345_Start(); //起始信號
ADXL345_SendByte(0xA6); //發(fā)送設(shè)備地址
ADXL345_SendByte(REG_Address); //內(nèi)部寄存器地址
ADXL345_SendByte(REG_data); //內(nèi)部寄存器數(shù)據(jù)
ADXL345_Stop(); //發(fā)送停止信號
}
//連續(xù)讀出ADXL345內(nèi)部加速度數(shù)據(jù),地址范圍0x32~0x37
void Multiple_read_ADXL345(void)
{
unsigned int i;
ADXL345_Start(); //起始信號
ADXL345_SendByte(0xA6); //發(fā)送設(shè)備地址+寫信號
ADXL345_SendByte(0x32); //發(fā)送存儲單元地址,從0x32開始
ADXL345_Start(); //起始信號
ADXL345_SendByte(0xA7); //發(fā)送設(shè)備地址+讀信號
for (i=0; i<6; i++) //連續(xù)讀取6個(gè)地址數(shù)據(jù),存儲中BUF
{
BUF[ i] = ADXL345_RecvByte(); //BUF[0]存儲0x32地址中的數(shù)據(jù)
if (i == 5){ADXL345_SendACK(1);}//最后一個(gè)數(shù)據(jù)需要回NOACK
else ADXL345_SendACK(0); //回應(yīng)ACK
}
ADXL345_Stop(); //停止信號
Delay(5);
}
//初始化ADXL345,根據(jù)需要請參考pdf進(jìn)行修改************************
void Init_ADXL345()
{
Single_Write_ADXL345(0x31,0x0B); //測量范圍,正負(fù)16g,13位模式
Single_Write_ADXL345(0x2C,0x08); //速率設(shè)定為12.5 參考pdf13頁
Single_Write_ADXL345(0x2D,0x08); //選擇電源模式 參考pdf24頁
Single_Write_ADXL345(0x2E,0x80); //使能 DATA_READY 中斷
Single_Write_ADXL345(0x1E,0x00); //X 偏移量 根據(jù)測試傳感器的狀態(tài)寫入pdf29頁
Single_Write_ADXL345(0x1F,0x00); //Y 偏移量 根據(jù)測試傳感器的狀態(tài)寫入pdf29頁
Single_Write_ADXL345(0x20,0x05); //Z 偏移量 根據(jù)測試傳感器的狀態(tài)寫入pdf29頁
}
void UartInit() //9600bps@11.0592MHz
{
TMOD=0X20;
TH1=0XFD;
TL1=0XFD;
TR1=1;
SM0=0;
SM1=1;
EA=1;
ES=1;
}
void Send(char JIE)
{
SBUF=JIE;
while(!TI);
TI=0;
}
//******主程序********
void main()
{
int a;
Delay(500);
UartInit();
Init_ADXL345();//初始化ADXL345
Delay(150);
while(1) //循環(huán)
{
a=0;
Multiple_Read_ADXL345(); //連續(xù)讀出數(shù)據(jù),存儲在BUF中
XYZ_data[0]=(BUF[1]<<8)+BUF[0];
XYZ_data[1]=(BUF[3]<<8)+BUF[2];
if(XYZ_data[0]>100)
a=1;
if(XYZ_data[0]<(-100))
a=2;
if(XYZ_data[0]>(-100)&&XYZ_data[0]<100)
a=3;
if(a==2&&XYZ_data[1]>100)
Send('5');
if(a==2&&XYZ_data[1]<-100)
Send('6');
if(a==2&&XYZ_data[1]>-100&&XYZ_data[1]<100)
Send('3');
if(a==1&&XYZ_data[1]>100)
Send('7');
if(a==1&&XYZ_data[1]<-100)
Send('8');
Delay(500);
}
}
|
|