|
#include <REG51.H> #include <math.h> //Keil library #include <stdio.h> //Keil library #include <INTRINS.H> #define uchar unsigned char #define uint unsigned int #define DataPort P0 //LCD1602數(shù)據(jù)端口 sbit SCL=P1^0; //IIC時(shí)鐘引腳定義 sbit SDA=P1^1; //IIC數(shù)據(jù)引腳定義 sbit LCM_RS=P2^0; //LCD1602命令端口 sbit LCM_RW=P2^1; //LCD1602命令端口 sbit LCM_EN=P2^2; //LCD1602命令端口 #define SlaveAddress 0xA6 //定義器件在IIC總線中的從地址,根據(jù)ALT ADDRESS地址引腳不同修改 //ALT ADDRESS引腳接地時(shí)地址為0xA6，接電源時(shí)地址為0x3A typedef unsigned char BYTE; typedef unsigned short WORD; BYTE BUF[8]; //接收數(shù)據(jù)緩存區(qū) uchar ge,shi,bai,qian,wan; //顯示變量 int dis_data; //變量 int data_xyz[3]; void delay(unsigned int k); void InitLcd(); //初始化lcd1602 void Init_ADXL345(void); //初始化ADXL345 void WriteDataLCM(uchar dataW); void WriteCommandLCM(uchar CMD,uchar Attribc); void DisplayOneChar(uchar X,uchar Y,uchar DData); void conversion(uint temp_data); void Single_Write_ADXL345(uchar REG_Address,uchar REG_data); //單個(gè)寫(xiě)入數(shù)據(jù) uchar Single_Read_ADXL345(uchar REG_Address); //單個(gè)讀取內(nèi)部寄存器數(shù)據(jù) void Multiple_Read_ADXL345(); //連續(xù)的讀取內(nèi)部寄存器數(shù)據(jù) //------------------------------------ void Delay5us(); void Delay5ms(); void ADXL345_Start(); void ADXL345_Stop(); void ADXL345_SendACK(bit ack); bit ADXL345_RecvACK(); void ADXL345_SendByte(BYTE dat); BYTE ADXL345_RecvByte(); void ADXL345_ReadPage(); void ADXL345_WritePage(); //----------------------------------- //********************************************************* void conversion(uint temp_data) { wan=temp_data/10000+0x30 ; temp_data=temp_data%10000; //取余運(yùn)算 qian=temp_data/1000+0x30; temp_data=temp_data%1000; //取余運(yùn)算 bai=temp_data/100+0x30 ; temp_data=temp_data%100; //取余運(yùn)算 shi=temp_data/10+0x30 ; temp_data=temp_data%10; //取余運(yùn)算 ge=temp_data+0x30; } /*******************************/ void delay(unsigned int k) { unsigned int i,j; for(i=0;i<k;i++) { for(j=0;j<121;j++) {;}} } /*******************************/ void WaitForEnable(void) { DataPort=0xff; LCM_RS=0;LCM_RW=1;_nop_(); LCM_EN=1;_nop_();_nop_(); while(DataPort&0x80); LCM_EN=0; } /*******************************/ void WriteCommandLCM(uchar CMD,uchar Attribc) { if(Attribc)WaitForEnable(); LCM_RS=0;LCM_RW=0;_nop_(); DataPort=CMD;_nop_(); LCM_EN=1;_nop_();_nop_();LCM_EN=0; } /*******************************/ void WriteDataLCM(uchar dataW) { WaitForEnable(); LCM_RS=1;LCM_RW=0;_nop_(); DataPort=dataW;_nop_(); LCM_EN=1;_nop_();_nop_();LCM_EN=0; } /***********************************/ void InitLcd() //液晶顯示器的設(shè)置 { WriteCommandLCM(0x38,1); WriteCommandLCM(0x08,1); WriteCommandLCM(0x01,1); WriteCommandLCM(0x06,1); WriteCommandLCM(0x0c,1); } /***********************************/ void DisplayOneChar(uchar X,uchar Y,uchar DData) { Y&=1; X&=15; if(Y)X|=0x40; X|=0x80; WriteCommandLCM(X,0); WriteDataLCM(DData); } /************************************** 延時(shí)5微秒(STC90C52RC@12M) 不同的工作環(huán)境,需要調(diào)整此函數(shù)，注意時(shí)鐘過(guò)快時(shí)需要修改 當(dāng)改用1T的MCU時(shí),請(qǐng)調(diào)整此延時(shí)函數(shù) **************************************/ void Delay5us() { _nop_();_nop_();_nop_();_nop_(); _nop_();_nop_();_nop_();_nop_(); _nop_();_nop_();_nop_();_nop_(); } /************************************** 延時(shí)5毫秒(STC90C52RC@12M) 不同的工作環(huán)境,需要調(diào)整此函數(shù) 當(dāng)改用1T的MCU時(shí),請(qǐng)調(diào)整此延時(shí)函數(shù) **************************************/ void Delay5ms() { WORD n = 560; while (n--); } /************************************** 起始信號(hào) **************************************/ void ADXL345_Start() { SDA = 1; //拉高數(shù)據(jù)線 SCL = 1; //拉高時(shí)鐘線 Delay5us(); //延時(shí) SDA = 0; //產(chǎn)生下降沿 Delay5us(); //延時(shí) SCL = 0; //拉低時(shí)鐘線 } /************************************** 停止信號(hào) **************************************/ void ADXL345_Stop() { SDA = 0; //拉低數(shù)據(jù)線 SCL = 1; //拉高時(shí)鐘線 Delay5us(); //延時(shí) SDA = 1; //產(chǎn)生上升沿 Delay5us(); //延時(shí) } /************************************** 發(fā)送應(yīng)答信號(hào) 入口參數(shù):ack (0:ACK 1:NAK) **************************************/ void ADXL345_SendACK(bit ack) { SDA = ack; //寫(xiě)應(yīng)答信號(hào) SCL = 1; //拉高時(shí)鐘線 Delay5us(); //延時(shí) SCL = 0; //拉低時(shí)鐘線 Delay5us(); //延時(shí) } /************************************** 接收應(yīng)答信號(hào) **************************************/ bit ADXL345_RecvACK() { SCL = 1; //拉高時(shí)鐘線 Delay5us(); //延時(shí) CY = SDA; //讀應(yīng)答信號(hào) SCL = 0; //拉低時(shí)鐘線 Delay5us(); //延時(shí) return CY; } /************************************** 向IIC總線發(fā)送一個(gè)字節(jié)數(shù)據(jù) **************************************/ void ADXL345_SendByte(BYTE dat) { BYTE i; for (i=0; i<8;i++) //8位計(jì)數(shù)器 { dat <<= 1; //移出數(shù)據(jù)的最高位 SDA = CY; //送數(shù)據(jù)口 SCL = 1; //拉高時(shí)鐘線 Delay5us(); //延時(shí) SCL = 0; //拉低時(shí)鐘線 Delay5us(); //延時(shí) } ADXL345_RecvACK(); } /************************************** 從IIC總線接收一個(gè)字節(jié)數(shù)據(jù) **************************************/ BYTE ADXL345_RecvByte() { BYTE i; BYTE 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é)寫(xiě)入******************************************* void Single_Write_ADXL345(uchar REG_Address,uchar REG_data) { ADXL345_Start(); //起始信號(hào) ADXL345_SendByte(SlaveAddress); //發(fā)送設(shè)備地址+寫(xiě)信號(hào) ADXL345_SendByte(REG_Address); //內(nèi)部寄存器地址，請(qǐng)參考中文pdf22頁(yè) ADXL345_SendByte(REG_data); //內(nèi)部寄存器數(shù)據(jù)，請(qǐng)參考中文pdf22頁(yè) ADXL345_Stop(); //發(fā)送停止信號(hào) } //********單字節(jié)讀取***************************************** uchar Single_Read_ADXL345(uchar REG_Address) { uchar REG_data; ADXL345_Start(); //起始信號(hào) ADXL345_SendByte(SlaveAddress); //發(fā)送設(shè)備地址+寫(xiě)信號(hào) ADXL345_SendByte(REG_Address); //發(fā)送存儲(chǔ)單元地址，從0開(kāi)始 ADXL345_Start(); //起始信號(hào) ADXL345_SendByte(SlaveAddress+1); //發(fā)送設(shè)備地址+讀信號(hào) REG_data=ADXL345_RecvByte(); //讀出寄存器數(shù)據(jù) ADXL345_SendACK(1); ADXL345_Stop(); //停止信號(hào) return REG_data; } //********************************************************* // //連續(xù)讀出ADXL345內(nèi)部加速度數(shù)據(jù)，地址范圍0x32~0x37 // //********************************************************* void Multiple_read_ADXL345(void) { uchar i; ADXL345_Start(); //起始信號(hào) ADXL345_SendByte(SlaveAddress); //發(fā)送設(shè)備地址+寫(xiě)信號(hào) ADXL345_SendByte(0x32); //發(fā)送存儲(chǔ)單元地址，從0x32開(kāi)始 ADXL345_Start(); //起始信號(hào) ADXL345_SendByte(SlaveAddress+1); //發(fā)送設(shè)備地址+讀信號(hào) for (i=0; i<6; i++) //連續(xù)讀取6個(gè)地址數(shù)據(jù)，存儲(chǔ)中BUF { BUF =ADXL345_RecvByte(); //BUF[0]存儲(chǔ)0x32地址中的數(shù)據(jù) if (i == 5) { ADXL345_SendACK(1); //最后一個(gè)數(shù)據(jù)需要回NOACK } else { ADXL345_SendACK(0); //回應(yīng)ACK } } ADXL345_Stop(); //停止信號(hào) Delay5ms(); } //***************************************************************** //初始化ADXL345，根據(jù)需要請(qǐng)參考pdf進(jìn)行修改************************ void Init_ADXL345() { Single_Write_ADXL345(0x31,0x0B); //測(cè)量范圍,正負(fù)16g，13位模式 Single_Write_ADXL345(0x2C,0x08); //速率設(shè)定為12.5 參考pdf13頁(yè) Single_Write_ADXL345(0x2D,0x08); //選擇電源模式 參考pdf24頁(yè) Single_Write_ADXL345(0x2E,0x80); //使能 DATA_READY 中斷 Single_Write_ADXL345(0x1E,0x00); //X 偏移量 根據(jù)測(cè)試傳感器的狀態(tài)寫(xiě)入pdf29頁(yè) Single_Write_ADXL345(0x1F,0x00); //Y 偏移量 根據(jù)測(cè)試傳感器的狀態(tài)寫(xiě)入pdf29頁(yè) Single_Write_ADXL345(0x20,0x05); //Z 偏移量 根據(jù)測(cè)試傳感器的狀態(tài)寫(xiě)入pdf29頁(yè) } //*********************************************************************** //顯示x軸 void display_x() { float temp; dis_data=(BUF[1]<<8)+BUF[0]; //合成數(shù)據(jù) if(dis_data<0){ dis_data=-dis_data; DisplayOneChar(2,0,'-'); //顯示正負(fù)符號(hào)位 } elseDisplayOneChar(2,0,' '); //顯示空格 temp=(float)dis_data*3.9; //計(jì)算數(shù)據(jù)和顯示,查考ADXL345快速入門(mén)第4頁(yè) conversion(temp); //轉(zhuǎn)換出顯示需要的數(shù)據(jù) DisplayOneChar(0,0,'X'); //第0行，第0列 顯示X DisplayOneChar(1,0,':'); DisplayOneChar(3,0,qian); DisplayOneChar(4,0,'.'); DisplayOneChar(5,0,bai); DisplayOneChar(6,0,shi); DisplayOneChar(7,0,'g'); } //*********************************************************************** //顯示y軸 void display_y() { float temp; dis_data=(BUF[3]<<8)+BUF[2]; //合成數(shù)據(jù) if(dis_data<0){ dis_data=-dis_data; DisplayOneChar(2,1,'-'); //顯示正負(fù)符號(hào)位 } elseDisplayOneChar(2,1,' '); //顯示空格 temp=(float)dis_data*3.9; //計(jì)算數(shù)據(jù)和顯示,查考ADXL345快速入門(mén)第4頁(yè) conversion(temp); //轉(zhuǎn)換出顯示需要的數(shù)據(jù) DisplayOneChar(0,1,'Y'); //第1行，第0列 顯示y DisplayOneChar(1,1,':'); DisplayOneChar(3,1,qian); DisplayOneChar(4,1,'.'); DisplayOneChar(5,1,bai); DisplayOneChar(6,1,shi); DisplayOneChar(7,1,'g'); } //*********************************************************************** //顯示z軸 void display_z() { float temp; dis_data=(BUF[5]<<8)+BUF[4]; //合成數(shù)據(jù) if(dis_data<0){ dis_data=-dis_data; DisplayOneChar(10,1,'-'); //顯示負(fù)符號(hào)位 } elseDisplayOneChar(10,1,' '); //顯示空格 temp=(float)dis_data*3.9; //計(jì)算數(shù)據(jù)和顯示,查考ADXL345快速入門(mén)第4頁(yè) conversion(temp); //轉(zhuǎn)換出顯示需要的數(shù)據(jù) /* DisplayOneChar(10,0,'Z'); //第0行，第10列 顯示Z DisplayOneChar(11,0,':'); DisplayOneChar(11,1,qian); DisplayOneChar(12,1,'.'); DisplayOneChar(13,1,bai); DisplayOneChar(14,1,shi); DisplayOneChar(15,1,'g'); */ } //********************************************************* //******主程序******** //********************************************************* void main() { uchar devid; float Roll,Pitch,Q,T,K; delay(500); //上電延時(shí) InitLcd(); //液晶初始化ADXL345 Init_ADXL345(); //初始化ADXL345 devid=Single_Read_ADXL345(0X00);//讀出的數(shù)據(jù)為0XE5,表示正確 while(1) //循環(huán) { Init_ADXL345(); //初始化ADXL345 Multiple_Read_ADXL345(); //連續(xù)讀出數(shù)據(jù)，存儲(chǔ)在BUF中 data_xyz[0]=(BUF[1]<<8)+BUF[0]; //合成數(shù)據(jù) data_xyz[1]=(BUF[3]<<8)+BUF[2]; //合成數(shù)據(jù) data_xyz[2]=(BUF[5]<<8)+BUF[4]; //合成數(shù)據(jù) //分別是加速度X,Y,Z的原始數(shù)據(jù)，10位的 Q=(float)data_xyz[0]*3.9; T=(float)data_xyz[1]*3.9; K=(float)data_xyz[2]*3.9; Q=-Q; Roll=(float)(((atan2(K,Q)*180)/3.14159265)+180); //X軸角度值 Pitch=(float)(((atan2(K,T)*180)/3.14159265)+180); //Y軸角度值 conversion(Roll); //轉(zhuǎn)換出顯示需要的數(shù)據(jù)X軸，或者Y軸 DisplayOneChar(9,1,'A'); DisplayOneChar(10,1,':'); DisplayOneChar(11,1,bai); DisplayOneChar(12,1,shi); DisplayOneChar(13,1,ge); delay(200); //延時(shí) } }
| 
