三軸陀螺儀MPU6050測試源碼分享

ID:333625 · 發(fā)表于 2018-5-19 13:49

轉(zhuǎn)載
//****************************************
#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時鐘引腳定義
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命令端口

//定義MPU3050內(nèi)部地址********************
#define WHO       0x00
#define SMPL 0x15
#define DLPF 0x16
#define INT_C 0x17
#define INT_S 0x1A
#define TMP_H 0x1B
#define TMP_L 0x1C
#define GX_H 0x1D
#define GX_L 0x1E
#define GY_H 0x1F
#define GY_L 0x20
#define GZ_H 0x21
#define GZ_L 0x22
#define PWR_M 0x3E
//****************************

#define SlaveAddress 0xD0    //定義器件在IIC總線中的從地址,根據(jù)ALT  ADDRESS地址引腳不同修改

typedef unsigned char  BYTE;
typedef unsigned short WORD;

uchar dis[4];                      //顯示數(shù)組
BYTE BUF[8];                      //接收數(shù)據(jù)緩存區(qū)
int  dis_data;                      //變量
int Temperature,Temp_h,Temp_l;
void delay(unsigned int k);
void InitLcd();                   //初始化lcd1602
void InitMPU3050();                //初始化MPU3050

void WriteDataLCM(uchar dataW);
void WriteCommandLCM(uchar CMD,uchar Attribc);
void DisplayOneChar(uchar X,uchar Y,uchar DData);
void DisplayListChar(uchar X,uchar Y,uchar *DData,L);

void  Single_WriteMPU3050(uchar REG_Address,uchar REG_data); //單個寫入數(shù)據(jù)
uchar Single_ReadMPU3050(uchar REG_Address);                //單個讀取內(nèi)部寄存器數(shù)據(jù)

//****************************************模擬IIC使用函數(shù)
void Delay5us();
void MPU3050_Start();
void MPU3050_Stop();
void MPU3050_SendACK(bit ack);
bit  MPU3050_RecvACK();
void MPU3050_SendByte(BYTE dat);
BYTE MPU3050_RecvByte();
void MPU3050_ReadPage();
void MPU3050_WritePage();
//****************************************
void display_x();
void display_y();
void display_z();

//****************************************

void lcd_printf(uchar *s,int temp_data)
{
if(temp_data<0){
temp_data=-temp_data;
*s='-';
}
else *s=' ';
*++s =temp_data/100+0x30;
temp_data=temp_data%100;    //取余運算
*++s =temp_data/10+0x30;
temp_data=temp_data%10;    //取余運算
*++s =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);
DisplayOneChar(0,0,'x');
DisplayOneChar(1,0,':');
DisplayOneChar(0,1,'y');
DisplayOneChar(1,1,':');
DisplayOneChar(9,0,'z');
DisplayOneChar(10,0,':');
DisplayOneChar(9,1,'T');
DisplayOneChar(10,1,':');
}
/***********************************/
void DisplayOneChar(uchar X,uchar Y,uchar DData)
{
Y&=1;
X&=15;
if(Y)X|=0x40;
X|=0x80;
WriteCommandLCM(X,0);
WriteDataLCM(DData);
}
/***********************************/
void DisplayListChar(uchar X,uchar Y,uchar *DData,L)
{
uchar ListLength=0;
Y&=0x1;
X&=0xF;
while(L--)
{
DisplayOneChar(X,Y,DData[ListLength]);
ListLength++;
X++;
}
}
/**************************************
延時5微秒(STC90C52RC@12M)
不同的工作環(huán)境,需要調(diào)整此函數(shù)，注意時鐘過快時需要修改
當(dāng)改用1T的MCU時,請調(diào)整此延時函數(shù)
**************************************/
void Delay5us()
{
_nop_();_nop_();_nop_();_nop_();
_nop_();_nop_();_nop_();_nop_();
_nop_();_nop_();_nop_();_nop_();
_nop_();_nop_();_nop_();_nop_();
_nop_();_nop_();_nop_();_nop_();
_nop_();_nop_();_nop_();_nop_();
}

/**************************************
起始信號
**************************************/
void MPU3050_Start()
{
SDA = 1;                   //拉高數(shù)據(jù)線
SCL = 1;                   //拉高時鐘線
Delay5us();                //延時
SDA = 0;                   //產(chǎn)生下降沿
Delay5us();                //延時
SCL = 0;                   //拉低時鐘線
}

/**************************************
停止信號
**************************************/
void MPU3050_Stop()
{
SDA = 0;                   //拉低數(shù)據(jù)線
SCL = 1;                   //拉高時鐘線
Delay5us();                //延時
SDA = 1;                   //產(chǎn)生上升沿
Delay5us();                //延時
}

/**************************************
發(fā)送應(yīng)答信號
入口參數(shù):ack (0:ACK 1:NAK)
**************************************/
void MPU3050_SendACK(bit ack)
{
SDA = ack;                //寫應(yīng)答信號
SCL = 1;                   //拉高時鐘線
Delay5us();                //延時
SCL = 0;                   //拉低時鐘線
Delay5us();                //延時
}

/**************************************
接收應(yīng)答信號
**************************************/
bit MPU3050_RecvACK()
{
SCL = 1;                   //拉高時鐘線
Delay5us();                //延時
CY = SDA;                //讀應(yīng)答信號
SCL = 0;                   //拉低時鐘線
Delay5us();                //延時

return CY;
}

/**************************************
向IIC總線發(fā)送一個字節(jié)數(shù)據(jù)
**************************************/
void MPU3050_SendByte(BYTE dat)
{
BYTE i;

for (i=0; i<8; i++)       //8位計數(shù)器
{
      dat <<= 1;             //移出數(shù)據(jù)的最高位
      SDA = CY;             //送數(shù)據(jù)口
      SCL = 1;             //拉高時鐘線
      Delay5us();          //延時
      SCL = 0;             //拉低時鐘線
      Delay5us();          //延時
}
MPU3050_RecvACK();
}

/**************************************
從IIC總線接收一個字節(jié)數(shù)據(jù)
**************************************/
BYTE MPU3050_RecvByte()
{
BYTE i;
BYTE dat = 0;

SDA = 1;                   //使能內(nèi)部上拉,準(zhǔn)備讀取數(shù)據(jù),
for (i=0; i<8; i++)       //8位計數(shù)器
{
      dat <<= 1;
      SCL = 1;             //拉高時鐘線
      Delay5us();          //延時
      dat |= SDA;          //讀數(shù)據(jù)
      SCL = 0;             //拉低時鐘線
      Delay5us();          //延時
}
return dat;
}

//單字節(jié)寫入*******************************************

void Single_WriteMPU3050(uchar REG_Address,uchar REG_data)
{
MPU3050_Start();                //起始信號
MPU3050_SendByte(SlaveAddress); //發(fā)送設(shè)備地址+寫信號
MPU3050_SendByte(REG_Address); //內(nèi)部寄存器地址，
MPU3050_SendByte(REG_data);    //內(nèi)部寄存器數(shù)據(jù)，
MPU3050_Stop();                //發(fā)送停止信號
}

//單字節(jié)讀取*****************************************
uchar Single_ReadMPU3050(uchar REG_Address)
{  uchar REG_data;
MPU3050_Start();                         //起始信號
MPU3050_SendByte(SlaveAddress);          //發(fā)送設(shè)備地址+寫信號
MPU3050_SendByte(REG_Address);          //發(fā)送存儲單元地址，從0開始
MPU3050_Start();                         //起始信號
MPU3050_SendByte(SlaveAddress+1);       //發(fā)送設(shè)備地址+讀信號
REG_data=MPU3050_RecvByte();             //讀出寄存器數(shù)據(jù)
MPU3050_SendACK(1);
MPU3050_Stop();                         //停止信號
return REG_data;
}

//初始化MPU3050，根據(jù)需要請參考pdf進(jìn)行修改************************
void InitMPU3050()
{
Single_WriteMPU3050(PWR_M, 0x80); //
Single_WriteMPU3050(SMPL, 0x07); //
Single_WriteMPU3050(DLPF, 0x1E); //±2000°
Single_WriteMPU3050(INT_C, 0x00 );  //
Single_WriteMPU3050(PWR_M, 0x00); //
}
//***********************************************************************
//顯示x軸
void display_x()
{
BUF[0]= Single_ReadMPU3050(GX_L);
BUF[1]= Single_ReadMPU3050(GX_H);
dis_data=(BUF[1]<<8)+BUF[0]; //合成數(shù)據(jù)
dis_data/=16.4;             //計算對應(yīng) 度/秒
lcd_printf(dis, dis_data);    //轉(zhuǎn)換數(shù)據(jù)顯示
DisplayListChar(2,0,dis,4); //啟始列，行，顯示數(shù)組，顯示長度
}

//***********************************************************************
//顯示y軸
void display_y()
{
BUF[2]= Single_ReadMPU3050(GY_L);
BUF[3]= Single_ReadMPU3050(GY_H);
dis_data=(BUF[3]<<8)+BUF[2]; //合成數(shù)據(jù)
dis_data/=16.4;             //計算對應(yīng) 度/秒
lcd_printf(dis, dis_data);    //轉(zhuǎn)換數(shù)據(jù)顯示
DisplayListChar(2,1,dis,4); //啟始列，行，顯示數(shù)組，顯示位數(shù)
}

//***********************************************************************
//顯示z軸
void display_z()
{
BUF[4]= Single_ReadMPU3050(GZ_L);
BUF[5]= Single_ReadMPU3050(GZ_H);
dis_data=(BUF[5]<<8)+BUF[4];    //合成數(shù)據(jù)
dis_data/=16.4;             //計算對應(yīng) 度/秒
lcd_printf(dis, dis_data);    //轉(zhuǎn)換數(shù)據(jù)顯示
DisplayListChar(11,0,dis,4);    //啟始列，行，顯示數(shù)組，顯示位數(shù)
}

//***********************************************************************
//顯示溫度
void display_temp()
{
Temp_h=Single_ReadMPU3050(TMP_H); //讀取溫度
Temp_l=Single_ReadMPU3050(TMP_L); //讀取溫度
Temperature=Temp_h<<8|Temp_l;    //合成溫度
Temperature = 35+ ((double) (Temperature + 13200)) / 280; // 計算出溫度
lcd_printf(dis,Temperature);    //轉(zhuǎn)換數(shù)據(jù)顯示
DisplayListChar(11,1,dis,4);    //啟始列，行，顯示數(shù)組，顯示位數(shù)
}

//*********************************************************
//******主程序********
//*********************************************************
void main()
{
  delay(500);                      //上電延時
  InitLcd();                      //液晶初始化
  InitMPU3050();                //初始化MPU3050
  delay(50);
  while(1)                      //循環(huán)
  {
display_x();                //---------顯示X軸
display_y();                //---------顯示Y軸
display_z();                //---------顯示Z軸
display_temp();             //---------顯示溫度
delay(100);                   //延時
  }
}

帳號		自動登錄	找回密碼
密碼			立即注冊

久久久久久久999_99精品久久精品一区二区爱城_成人欧美一区二区三区在线播放_国产精品日本一区二区不卡视频_国产午夜视频_欧美精品在线观看免费

三軸陀螺儀MPU6050測試源碼分享

評分