?? stc_lsm303dlh.c
字號:
//***************************************
// LSM303DLH IIC測試程序
// 使用單片機STC89C51
// 晶振：11.0592M
// 顯示：LCD1602
// 編譯環境 Keil uVision2
// 參考宏晶網站24c04通信程序
// 時間：2011年3月1日
// QQ：531389319
//****************************************
#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數據端口
sbit SCL=P1^0; //IIC時鐘引腳定義
sbit SDA=P1^1; //IIC數據引腳定義
sbit LCM_RS=P2^0; //LCD1602命令端口
sbit LCM_RW=P2^1; //LCD1602命令端口
sbit LCM_EN=P2^2; //LCD1602命令端口
#define LSM303A_SlaveAddress 0x30 //定義器件在IIC總線中的從地址,(加速度)根據ALT ADDRESS地址引腳不同修改 0x30（ADDRESS=0）
#define LSM303M_SlaveAddress 0x3C //定義器件在IIC總線中的從地址,(磁場)根據ALT ADDRESS地址引腳不同修改
typedef unsigned char BYTE;
typedef unsigned short WORD;
BYTE BUF[8]; //接收數據緩存區
uchar ge,shi,bai,qian,wan; //顯示變量
int dis_data; //變量
void delay(unsigned int k);
void InitLcd(); //初始化lcd1602
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(uchar SlaveAddress,uchar REG_Address,uchar REG_data); //單個寫入數據
uchar Single_Read(uchar SlaveAddress,uchar REG_Address); //單個讀取內部寄存器數據
void Multiple_Read(uchar,uchar); //連續的讀取內部寄存器數據
//------------------------------------
void Delay5us();
void Delay5ms();
void LSM303_Start();
void LSM303_Stop();
void LSM303_SendACK(bit ack);
bit LSM303_RecvACK();
void LSM303_SendByte(BYTE dat);
BYTE LSM303_RecvByte();
void LSM303_ReadPage();
void LSM303_WritePage();
//-----------------------------------
//*********************************************************
void conversion(uint temp_data)
{
wan=temp_data/10000+0x30 ;
temp_data=temp_data%10000; //取余運算
qian=temp_data/1000+0x30 ;
temp_data=temp_data%1000; //取余運算
bai=temp_data/100+0x30 ;
temp_data=temp_data%100; //取余運算
shi=temp_data/10+0x30 ;
temp_data=temp_data%10; //取余運算
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()
{
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);
}
/**************************************
延時5微秒(STC90C52RC@12M)
不同的工作環境,需要調整此函數，注意時鐘過快時需要修改
當改用1T的MCU時,請調整此延時函數
**************************************/
void Delay5us()
{
_nop_();_nop_();_nop_();_nop_();
_nop_();_nop_();_nop_();_nop_();
_nop_();_nop_();_nop_();_nop_();
_nop_();_nop_();_nop_();_nop_();
}
/**************************************
延時5毫秒(STC90C52RC@12M)
不同的工作環境,需要調整此函數
當改用1T的MCU時,請調整此延時函數
**************************************/
void Delay5ms()
{
WORD n = 560;
while (n--);
}
/**************************************
起始信號
**************************************/
void LSM303_Start()
{
SDA = 1; //拉高數據線
SCL = 1; //拉高時鐘線
Delay5us(); //延時
SDA = 0; //產生下降沿
Delay5us(); //延時
SCL = 0; //拉低時鐘線
}
/**************************************
停止信號
**************************************/
void LSM303_Stop()
{
SDA = 0; //拉低數據線
SCL = 1; //拉高時鐘線
Delay5us(); //延時
SDA = 1; //產生上升沿
Delay5us(); //延時
}
/**************************************
發送應答信號
入口參數:ack (0:ACK 1:NAK)
**************************************/
void LSM303_SendACK(bit ack)
{
SDA = ack; //寫應答信號
SCL = 1; //拉高時鐘線
Delay5us(); //延時
SCL = 0; //拉低時鐘線
Delay5us(); //延時
}
/**************************************
接收應答信號
**************************************/
bit LSM303_RecvACK()
{
SCL = 1; //拉高時鐘線
Delay5us(); //延時
CY = SDA; //讀應答信號
SCL = 0; //拉低時鐘線
Delay5us(); //延時
return CY;
}
/**************************************
向IIC總線發送一個字節數據
**************************************/
void LSM303_SendByte(BYTE dat)
{
BYTE i;
for (i=0; i<8; i++) //8位計數器
{
dat <<= 1; //移出數據的最高位
SDA = CY; //送數據口
SCL = 1; //拉高時鐘線
Delay5us(); //延時
SCL = 0; //拉低時鐘線
Delay5us(); //延時
}
LSM303_RecvACK();
}
/**************************************
從IIC總線接收一個字節數據
**************************************/
BYTE LSM303_RecvByte()
{
BYTE i;
BYTE dat = 0;
SDA = 1; //使能內部上拉,準備讀取數據,
for (i=0; i<8; i++) //8位計數器
{
dat <<= 1;
SCL = 1; //拉高時鐘線
Delay5us(); //延時
dat |= SDA; //讀數據
SCL = 0; //拉低時鐘線
Delay5us(); //延時
}
return dat;
}
//單字節寫入LSM303內部數據*******************************
void Single_Write(uchar SlaveAddress,uchar REG_Address,uchar REG_data)
{
LSM303_Start(); //起始信號
LSM303_SendByte(SlaveAddress); //發送設備地址+寫信號
LSM303_SendByte(REG_Address); //內部寄存器地址
LSM303_SendByte(REG_data); //內部寄存器數據
LSM303_Stop(); //發送停止信號
}
//單字節讀取LSM303內部數據********************************
uchar Single_Read(uchar SlaveAddress,uchar REG_Address)
{ uchar REG_data;
LSM303_Start(); //起始信號
LSM303_SendByte(SlaveAddress); //發送設備地址+寫信號
LSM303_SendByte(REG_Address); //發送存儲單元地址
LSM303_Start(); //起始信號
LSM303_SendByte(SlaveAddress+1); //發送設備地址+讀信號
REG_data=LSM303_RecvByte(); //讀出寄存器數據
LSM303_SendACK(1);
LSM303_Stop(); //停止信號
return REG_data;
}
//*********************************************************
//連續讀出LSM303內部數據
//*********************************************************
void Multiple_read(uchar SlaveAddress,uchar ST_Address)
{ uchar i;
LSM303_Start(); //起始信號
LSM303_SendByte(SlaveAddress); //發送設備地址+寫信號
LSM303_SendByte(ST_Address); //發送存儲單元地址
LSM303_Start(); //起始信號
LSM303_SendByte(SlaveAddress+1); //發送設備地址+讀信號
for (i=0; i<6; i++) //連續讀取6個地址數據，存儲中BUF
{
BUF[i] = LSM303_RecvByte(); //BUF[0]存儲
if (i == 5)
{
LSM303_SendACK(1); //最后一個數據需要回NOACK
}
else
{
LSM303_SendACK(0); //回應ACK
}
}
LSM303_Stop(); //停止信號
Delay5ms();
}
//**************************************************************
//初始化LSM303A(加速度)，根據需要請參考pdf進行修改**************
void Init_LSM303A()
{
Single_Write(LSM303A_SlaveAddress,0x20,0x27); //測量范圍,正負2g，16位模式
}
//初始化LSM303M(磁場)，根據需要請參考pdf進行修改****
void Init_LSM303M()
{
Single_Write(LSM303M_SlaveAddress,0x02,0x00); //
}
//**************************************************************
//加速度顯示x軸
void display_x()
{ float temp;
BUF[0]=Single_Read(LSM303A_SlaveAddress,0x28);//OUT_X_L_A
BUF[1]=Single_Read(LSM303A_SlaveAddress,0x29);//OUT_X_H_A
dis_data=(BUF[1]<<8)+BUF[0]; //合成數據
if(dis_data<0){
dis_data=-dis_data;
DisplayOneChar(2,0,'-'); //顯示正負符號位
}
else DisplayOneChar(2,0,' '); //顯示空格
temp=(float)dis_data/16.383; //
conversion(temp); //轉換出顯示需要的數據
DisplayOneChar(0,0,'X'); //第0行，第0列 顯示X
DisplayOneChar(1,0,':');
DisplayOneChar(3,0,qian);
DisplayOneChar(4,0,'.');
DisplayOneChar(5,0,bai);
DisplayOneChar(6,0,'g');
}
//***************************************************************
//加速度顯示y軸
void display_y()
{ float temp;
BUF[2]=Single_Read(LSM303A_SlaveAddress,0x2a);//OUT_Y_L_A
BUF[3]=Single_Read(LSM303A_SlaveAddress,0x2b);//OUT_Y_H_A
dis_data=(BUF[3]<<8)+BUF[2]; //合成數據
if(dis_data<0){
dis_data=-dis_data;
DisplayOneChar(2,1,'-'); //顯示正負符號位
}
else DisplayOneChar(2,1,' '); //顯示空格
temp=(float)dis_data/16.383; //計算數據和顯示
conversion(temp); //轉換出顯示需要的數據
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(6,1,'g');
}
//**************************************************************
//加速度顯示z軸
void display_z()
{ float temp;
BUF[4]=Single_Read(LSM303A_SlaveAddress,0x2c);//OUT_Z_L_A
BUF[5]=Single_Read(LSM303A_SlaveAddress,0x2d);//OUT_Z_H_A
dis_data=(BUF[5]<<8)+BUF[4]; //合成數據
if(dis_data<0){
dis_data=-dis_data;
DisplayOneChar(11,1,'-'); //顯示負符號位
}
else DisplayOneChar(11,1,' ');//顯示空格
temp=(float)dis_data/16.383; //計算數據和顯示
conversion(temp); //轉換出顯示需要的數據
DisplayOneChar(9,1,'Z'); //第0行，第10列 顯示Z
DisplayOneChar(10,1,':');
DisplayOneChar(12,1,qian);
DisplayOneChar(13,1,'.');
DisplayOneChar(14,1,bai);
// DisplayOneChar(14,1,shi);
DisplayOneChar(15,1,'g');
}
void display_Angle(void)
{ int x,y,z;
double angle;
x=BUF[0] << 8 | BUF[1]; //Combine MSB and LSB of X Data output register
y=BUF[2] << 8 | BUF[3]; //Combine MSB and LSB of Z Data output register
z=BUF[4] << 8 | BUF[5]; //Combine MSB and LSB of Y Data output register
angle= atan2((double)y,(double)x) * (180 / 3.14159265) + 180; // angle in degrees
angle*=10;
conversion(angle); //計算數據和顯示
DisplayOneChar(9,0,'A');
DisplayOneChar(10,0,':');
DisplayOneChar(11,0,qian);
DisplayOneChar(12,0,bai);
DisplayOneChar(13,0,shi);
DisplayOneChar(14,0,'.');
DisplayOneChar(15,0,ge);
}
//*********************************************************
//******主程序********
//*********************************************************
void main()
{
delay(50); //上電延時
InitLcd(); //液晶初始化
Init_LSM303A(); //初始化LSM303 加速度
Init_LSM303M(); //初始化LSM303 磁場
while(1) //循環
{
delay(10); //延時
display_x(); //---------加速度，顯示X軸
display_y(); //---------加速度，顯示Y軸
display_z(); //---------加速度，顯示Z軸
delay(10); //延時
Multiple_Read(LSM303M_SlaveAddress,0X03); //連續讀出數據，存儲在BUF中
display_Angle(); //---------磁場，顯示角度
delay(100);
}
} ?? 快捷鍵說明
復制代碼
Ctrl + C
搜索代碼
Ctrl + F
全屏模式
F11
切換主題
Ctrl + Shift + D
顯示快捷鍵
?
增大字號
Ctrl + =
減小字號
Ctrl + -