吴忠躺衫网络科技有限公司

0
  • 聊天消息
  • 系統消息
  • 評論與回復
登錄后你可以
  • 下載海量資料
  • 學習在線課程
  • 觀看技術視頻
  • 寫文章/發帖/加入社區
會員中心
創作中心

完善資料讓更多小伙伴認識你,還能領取20積分哦,立即完善>

3天內不再提示

STM32入門學習筆記之MPU6050傳感器解析實驗4

jf_78858299 ? 來源:滑小稽筆記 ? 作者:電子技術園地 ? 2023-02-16 14:54 ? 次閱讀

(2)創建mpu6050.c文件,輸入以下代碼。

/*********************************************************************************************************
                MUP6050    驅    動    程    序
*********************************************************************************************************/
#include "mpu6050.h"
#include "delay.h"
/***************************************************
Name    :MPU_IIC_Init
Function  :初始化IIC
Paramater  :None
Return    :None
***************************************************/
void MPU_IIC_Init()
{
   RCC->APB2ENR |= 1<<3 ;                                        //先使能PB時鐘
  GPIOB->CRH &= 0xFFFF00FF ;                                      //PB10/11 推挽輸出
  GPIOB->CRH |= 0x00003300 ;
  GPIOB->ODR |= 3<<10 ;                                        //PB10,11 輸出高
}
/***************************************************
Name    :MPU_IIC_Wait_Ack
Function  :開始時序
Paramater  :None
Return    :None
***************************************************/
void MPU_IIC_Start()
{
  GPIOB->CRH &= 0xFFFF0FFF ;
  GPIOB->CRH |= 0x00003000 ;
  MPU_IIC_SDA = 1 ;
  MPU_IIC_SCL = 1 ;
  delay_us( 2 ) ;
  MPU_IIC_SDA = 0 ;
  delay_us( 2 ) ;
  MPU_IIC_SCL = 0 ;
}
/***************************************************
Name    :MPU_IIC_Wait_Ack
Function  :停止時序
Paramater  :None
Return    :None
***************************************************/
void MPU_IIC_Stop()
{
  GPIOB->CRH &= 0xFFFF0FFF ;
  GPIOB->CRH |= 0x00003000 ;
  MPU_IIC_SCL = 0 ;
  MPU_IIC_SDA = 0 ;
  delay_us( 2 ) ;
  MPU_IIC_SCL = 1 ;
  MPU_IIC_SDA = 1 ;
  delay_us( 2 ) ;
}
/***************************************************
Name    :MPU_IIC_Wait_Ack
Function  :應答時序
Paramater  :None
Return    :
      0:成功
      1:失敗
***************************************************/
u8 MPU_IIC_Wait_Ack()
{
  u8 ucErrTime=0 ;
  GPIOB->CRH &= 0xFFFF0FFF ;
  GPIOB->CRH |= 0x00008000 ;
  MPU_IIC_SDA = 1 ;
  delay_us( 2 ) ;
  MPU_IIC_SCL = 1 ;
  delay_us( 2 ) ;
  while( MPU_READ_SDA )
  {
    ucErrTime ++ ;
    if( ucErrTime>250 )
    {
      MPU_IIC_Stop() ;
      return 1 ;
    }
  }
  MPU_IIC_SCL = 0 ;                                          //時鐘輸出0
  return 0 ;
}
/***************************************************
Name    :MPU_IIC_Send_Byte
Function  :IIC發送1個字節
Paramater  :
      Ack:應答控制
        0:不應答
        1:應答
Return    :None
***************************************************/
void MPU_IIC_Send_Byte( u8 Byte )
{
  u8 i ;
  GPIOB->CRH &= 0xFFFF0FFF ;
  GPIOB->CRH |= 0x00003000 ;
  MPU_IIC_SCL = 0 ;                                          //拉低時鐘開始數據傳輸
  for( i=0; i<8; i++ )
  {
    if( ( Byte&0x80 )==0x80 )
      MPU_IIC_SDA = 1 ;
    else
      MPU_IIC_SDA = 0 ;
        Byte <<= 1 ;
    MPU_IIC_SCL = 1 ;
    delay_us( 2 ) ;
    MPU_IIC_SCL = 0 ;
    delay_us( 2 ) ;
  }
}
/***************************************************
Name    :MPU_IIC_Read_Byte
Function  :IIC讀取1個字節
Paramater  :
      Ack:應答控制
        0:不應答
        1:應答
Return    :讀取的字節
***************************************************/
u8 MPU_IIC_Read_Byte( u8 Ack )
{
  u8 i, Byte=0;
  GPIOB->CRH &= 0xFFFF0FFF ;
  GPIOB->CRH |= 0x00008000 ;
    for( i=0; i<8; i++ )
  {
    MPU_IIC_SCL = 0 ;
    delay_us( 2 ) ;
    MPU_IIC_SCL = 1 ;
    Byte <<= 1 ;
    if( MPU_READ_SDA )
      Byte ++ ;
    delay_us( 2 ) ;
  }
  MPU_IIC_SCL = 0 ;
  GPIOB->CRH &= 0xFFFF0FFF ;
  GPIOB->CRH |= 0x00003000 ;
  MPU_IIC_SDA = 1-Ack ;
  delay_us( 2 ) ;
  MPU_IIC_SCL = 1 ;
  delay_us( 2 ) ;
  MPU_IIC_SCL = 0 ;
  return Byte ;
}
/***************************************************
Name    :MPU_Write_Byte
Function  :IIC寫一個字節
Paramater  :
      reg:寄存器地址
      data:數據
Return    :
      0:正常
      其他:錯誤代碼
***************************************************/
u8 MPU_Write_Byte( u8 reg, u8 data )
{ 
    MPU_IIC_Start() ; 
  MPU_IIC_Send_Byte( MPU_ADDR<<1 ) ;                                  //發送器件地址+寫命令
  //等待應答
  if( MPU_IIC_Wait_Ack() )
  {
    MPU_IIC_Stop() ;
    return 1 ;
  }
    MPU_IIC_Send_Byte( reg ) ;                                      //寫寄存器地址
    MPU_IIC_Wait_Ack() ;                                        //等待應答
  MPU_IIC_Send_Byte( data ) ;                                      //發送數據
  //等待ACK
  if( MPU_IIC_Wait_Ack() )
  {
    MPU_IIC_Stop() ;
    return 1 ;
  }
    MPU_IIC_Stop() ;
  return 0 ;
}
/***************************************************
Name    :MPU_Read_Byte
Function  :IIC讀一個字節
Paramater  :
      reg:寄存器地址
Return    :讀到的數據
***************************************************/
u8 MPU_Read_Byte( u8 reg )
{
  u8 res ;
    MPU_IIC_Start() ;
  MPU_IIC_Send_Byte( MPU_ADDR<<1 ) ;                                  //發送器件地址+寫命令
  MPU_IIC_Wait_Ack() ;                                        //等待應答
    MPU_IIC_Send_Byte( reg ) ;                                      //寫寄存器地址
    MPU_IIC_Wait_Ack() ;                                        //等待應答
    MPU_IIC_Start() ;
  MPU_IIC_Send_Byte( ( MPU_ADDR<<1 )|1 ) ;                              //發送器件地址+讀命令
    MPU_IIC_Wait_Ack() ;                                        //等待應答
  res = MPU_IIC_Read_Byte( 0 ) ;                                    //讀取數據,發送nACK
    MPU_IIC_Stop() ;                                          //產生一個停止條件
  return res ;
}
/***************************************************
Name    :MPU_Read_Byte
Function  :設置MPU6050的采樣率(假定Fs=1KHz)
Paramater  :
      rate:4~1000(Hz)
Return    :
      0:成功
      其他:失敗
***************************************************/
u8 MPU_Set_Rate( u16 rate )
{
  u8 data ;
  if( rate>1000 )
    rate=1000 ;
  if( rate<4 )
    rate = 4 ;
  data = 1000/rate-1 ;
  data = MPU_Write_Byte( MPU_SAMPLE_RATE_REG, data ) ;                        //設置數字低通濾波器
  //自動設置LPF為采樣率的一半
  if( ( rate/2 )>=188 )
    data = 1 ;
  else if( ( rate/2 )>=98 )
    data = 2 ;
  else if( ( rate/2 )>=42 )
    data = 3 ;
  else if( ( rate/2 )>=20 )
    data = 4;
  else if( ( rate/2 )>=10 )
    data = 5 ;
  else
    data = 6 ;
  return MPU_Write_Byte( MPU_CFG_REG, data ) ;                            //設置數字低通濾波器
}
/***************************************************
Name    :MPU_Init
Function  :初始化MPU6050
Paramater  :None
Return    :
      0:成功
      其他:錯誤代碼
***************************************************/
u8 MPU_Init()
{ 
  u8 res ;
  RCC->APB2ENR |= 1<<2 ;                                        //使能PORTA時鐘 
  GPIOA->CRH &= 0x0FFFFFFF ;                                      //PA15設置成推挽輸出    
  GPIOA->CRH |= 0x30000000 ; 
  JTAG_Set( 1 ) ;                                            //禁止JTAG,從而PA15可以做普通IO使用,否則PA15不能做普通IO
  MPU_AD0_CTRL = 0 ;                                          //控制MPU6050的AD0腳為低電平,從機地址為:0X68
  //初始化IIC總線
  RCC->APB2ENR |= 1<<3 ;                                        //先使能PB時鐘
  GPIOB->CRH &= 0xFFFF00FF ;                                      //PB10/11 推挽輸出
  GPIOB->CRH |= 0x00003300 ;
  GPIOB->ODR |= 3<<10 ;                                        //PB10,11 輸出高
  MPU_Write_Byte( MPU_PWR_MGMT1_REG, 0x80 ) ;                              //復位MPU6050
    delay_ms( 100 ) ;
  MPU_Write_Byte( MPU_PWR_MGMT1_REG, 0x00 ) ;                              //喚醒MPU6050
  MPU_Write_Byte( MPU_GYRO_CFG_REG, 3<<3 ) ;                              //陀螺儀傳感器,±2000dps
  MPU_Write_Byte( MPU_ACCEL_CFG_REG, 0<<3 ) ;                              //加速度傳感器,±2g
  MPU_Set_Rate( 50 ) ;                                        //設置采樣率50Hz
  MPU_Write_Byte( MPU_INT_EN_REG, 0x00 ) ;                              //關閉所有中斷
  MPU_Write_Byte( MPU_USER_CTRL_REG, 0x00 ) ;                              //I2C主模式關閉
  MPU_Write_Byte( MPU_FIFO_EN_REG, 0x00 ) ;                              //關閉FIFO
  MPU_Write_Byte( MPU_INTBP_CFG_REG, 0x80 ) ;                              //INT引腳低電平有效
  res = MPU_Read_Byte( MPU_DEVICE_ID_REG ) ;
  //器件ID正確
  if( res==MPU_ADDR )
  {
    MPU_Write_Byte( MPU_PWR_MGMT1_REG, 0x01 ) ;                            //設置CLKSEL,PLL X軸為參考
    MPU_Write_Byte( MPU_PWR_MGMT2_REG, 0x00 ) ;                            //加速度與陀螺儀都工作
    MPU_Set_Rate( 50 ) ;                                      //設置采樣率為50Hz
   }
  else
    return 1 ;
  return 0 ;
}
/***************************************************
Name    :MPU_Write_Len
Function  :IIC連續寫
Paramater  :
      addr:器件地址
      reg:寄存器地址
      len:寫入長度
      buf:數據區
Return    :
      0:成功
      其他:錯誤代碼
***************************************************/
u8 MPU_Write_Len( u8 addr, u8 reg, u8 len, u8 *buf )
{
  u8 i ;
    MPU_IIC_Start() ;
  MPU_IIC_Send_Byte( addr<<1 ) ;                                    //發送器件地址+寫命令
  if( MPU_IIC_Wait_Ack() )                                      //等待應答
  {
    MPU_IIC_Stop() ;
    return 1 ;
  }
    MPU_IIC_Send_Byte( reg ) ;                                      //寫寄存器地址
    MPU_IIC_Wait_Ack() ;                                        //等待應答
  for( i=0; i

(3)創建1.c文件,輸入以下代碼。

#include "sys.h"
#include "delay.h"
#include "usart1.h"
#include "lcd.h"
#include "mpu6050.h"
#include "inv_mpu.h"
#include "inv_mpu_dmp_motion_driver.h"


int main()
{
  u8 t, Str[ 20 ] ;
  float pitch, roll, yaw ;                                      //歐拉角
  short aacx, aacy, aacz ;                                      //加速度傳感器原始數據
  short gyrox, gyroy, gyroz ;                                      //陀螺儀原始數據
  float temp ;                                            //溫度
   STM32_Clock_Init( 9 ) ;                                        //系統時鐘設置
  SysTick_Init( 72 ) ;                                        //延時初始化
  USART1_Init( 72, 500000 ) ;                                      //串口初始化為500000
  LCD_Init() ;                                            //初始化LCD
  MPU_Init() ;                                            //初始化MPU6050
  while( mpu_dmp_init() ) ;
  POINT_COLOR = RED ;                                          //設置字體為藍色
   while(1)
  {
    if( mpu_dmp_get_data( &pitch, &roll, &yaw )==0 )
    {
      temp = ( float )MPU_Get_Temperature()/100 ;                          //得到溫度值
      MPU_Get_Accelerometer( &aacx, &aacy, &aacz ) ;                        //得到加速度傳感器數據
      MPU_Get_Gyroscope( &gyrox, &gyroy, &gyroz ) ;                        //得到陀螺儀數據
      //轉換溫度
      sprintf( ( char* )Str, "Temp: %.2f C", temp ) ;
      for( t=0; t<20; t++ )
      {
        if( Str[ t ]=='.' )
        {
          t += 4 ;
          while( t<20 )
          {
            t ++ ;
            Str[ t ] = ' ' ;
          }
        }
      }
      LCD_ShowString( 10, 0, Str ) ;
      //自轉角
      sprintf( ( char* )Str, "Pitch: %.1f C", pitch  ) ;
      for( t=0; t<20; t++ )
      {
        if( Str[ t ]=='.' )
        {
          t += 3 ;
          while( t<20 )
          {
            t ++ ;
            Str[ t ] = ' ' ;
          }
        }
      }
      LCD_ShowString( 10, 30, Str ) ;


      //章動角
      sprintf( ( char* )Str, "Roll: %.1f C", roll  ) ;
      for( t=0; t<20; t++ )
      {
        if( Str[ t ]=='.' )
        {
          t += 3 ;
          while( t<20 )
          {
            t ++ ;
            Str[ t ] = ' ' ;
          }
        }
      }
      LCD_ShowString( 10, 60, Str ) ;


      //旋轉角
      sprintf( ( char* )Str, "Yaw: %.1f C", yaw  ) ;
      for( t=0; t<20; t++ )
      {
        if( Str[ t ]=='.' )
        {
          t += 3 ;
          while( t<20 )
          {
            t ++ ;
            Str[ t ] = ' ' ;
          }
        }
      }
      LCD_ShowString( 10, 90, Str ) ;
    }
  }
}

注:例程使用了網上已經移植成功的DMP源碼,直接調用即可。

聲明:本文內容及配圖由入駐作者撰寫或者入駐合作網站授權轉載。文章觀點僅代表作者本人,不代表電子發燒友網立場。文章及其配圖僅供工程師學習之用,如有內容侵權或者其他違規問題,請聯系本站處理。 舉報投訴
  • 傳感器
    +關注

    關注

    2553

    文章

    51390

    瀏覽量

    756571
  • 處理器
    +關注

    關注

    68

    文章

    19407

    瀏覽量

    231181
  • MPU6050
    +關注

    關注

    39

    文章

    307

    瀏覽量

    71662
收藏 人收藏

    評論

    相關推薦

    STM32控制MPU6050使用說明

    STM32 控制MPU6050使用說明 mpu6050是陀螺儀、加速計和一個可擴展的傳根RM-MPU
    發表于 07-02 08:05

    STM32解析MPU6050上位機與下位機源碼

    STM32解析MPU6050 MPU6050使用說明書V4.pdf 上位機.rar STM32
    發表于 07-02 08:04

    STM32控制MPU6050使用說明

    STM32 控制MPU6050使用說明 mpu6050是陀螺儀、加速計和一個可擴展的傳根RM-MPU
    發表于 07-06 02:25

    基于stm32mpu6050傳感器實驗 精選資料推薦

    @TOCMPU6050+STM32學習筆記學習了差不多兩天的mpu6050,參考了很多篇博客還有看一些資料,今晚終于把這個東西在我的串口顯示
    發表于 08-17 09:23

    如何對基于stm32mpu6050傳感器進行測試呢

    如何對基于stm32mpu6050傳感器進行測試呢?有哪些測試步驟呢?
    發表于 11-18 06:59

    MPU6050六軸傳感器筆記分享

    MPU6050六軸傳感器1 自帶數字運動處理2 集成可程序控制(陀螺儀)3 集成可程序控制(加速度傳感器4 自帶數字溫度傳感器5 可輸出中
    發表于 02-10 06:49

    基于STM32單片機+MPU6050傳感器做的載人平衡車

    基于STM32單片機+MPU6050傳感器做的載人平衡車
    發表于 01-20 15:54 ?236次下載

    mpu6050六軸傳感器模塊驅動程序源代碼分享

    本文為大家分享了mpu6050六軸傳感器模塊驅動程序源代碼,STM32F1讀取MPU6050的加速度和角度傳感器數據的初始化步驟,以及
    發表于 12-11 14:26 ?3.7w次閱讀
    <b class='flag-5'>mpu6050</b>六軸<b class='flag-5'>傳感器</b>模塊驅動程序源代碼分享

    使用STM32單片機讀取MPU6050傳感器數據的程序免費下載

    本文檔的主要內容詳細介紹的是使用STM32單片機讀取MPU6050傳感器數據的程序免費下載。
    發表于 07-26 17:35 ?61次下載
    使用<b class='flag-5'>STM32</b>單片機讀取<b class='flag-5'>MPU6050</b><b class='flag-5'>傳感器</b>數據的程序免費下載

    MPU6050六軸傳感器實驗的程序和工程文件免費下載

    本文檔的主要內容詳細介紹的是MPU6050六軸傳感器實驗的程序和工程文件免費下載。
    發表于 09-20 08:00 ?16次下載
    <b class='flag-5'>MPU6050</b>六軸<b class='flag-5'>傳感器</b><b class='flag-5'>實驗</b>的程序和工程文件免費下載

    MPU6050六軸陀螺儀傳感器實驗的資料合集免費下載

    本文檔的主要內容詳細介紹的是MPU6050六軸陀螺儀傳感器實驗的資料合集免費下載。
    發表于 06-02 08:00 ?29次下載
    <b class='flag-5'>MPU6050</b>六軸陀螺儀<b class='flag-5'>傳感器</b><b class='flag-5'>實驗</b>的資料合集免費下載

    基于stm32mpu6050傳感器實驗

    @TOCMPU6050+STM32學習筆記學習了差不多兩天的mpu6050,參考了很多篇博客還有看一些資料,今晚終于把這個東西在我的串口顯示
    發表于 12-06 11:36 ?9次下載
    基于<b class='flag-5'>stm32</b>的<b class='flag-5'>mpu6050</b><b class='flag-5'>傳感器</b><b class='flag-5'>實驗</b>

    STM32入門學習筆記MPU6050傳感器解析實驗1

    MPU6050是InvenSense公司推出的一款6軸運動處理芯片,內置3軸陀螺儀及3軸速度傳感器,內置兩組I2C接口,其中一組用于通信,另一組則用于連接外部磁力傳感器,采用自帶的數字運動處理
    的頭像 發表于 02-16 14:53 ?5394次閱讀
    <b class='flag-5'>STM32</b><b class='flag-5'>入門</b><b class='flag-5'>學習</b><b class='flag-5'>筆記</b><b class='flag-5'>之</b><b class='flag-5'>MPU6050</b><b class='flag-5'>傳感器</b><b class='flag-5'>解析</b><b class='flag-5'>實驗</b>1

    STM32入門學習筆記MPU6050傳感器解析實驗2

    MPU6050是InvenSense公司推出的一款6軸運動處理芯片,內置3軸陀螺儀及3軸速度傳感器,內置兩組I2C接口,其中一組用于通信,另一組則用于連接外部磁力傳感器,采用自帶的數字運動處理
    的頭像 發表于 02-16 14:54 ?1290次閱讀

    STM32入門學習筆記MPU6050傳感器解析實驗3

    MPU6050是InvenSense公司推出的一款6軸運動處理芯片,內置3軸陀螺儀及3軸速度傳感器,內置兩組I2C接口,其中一組用于通信,另一組則用于連接外部磁力傳感器,采用自帶的數字運動處理
    的頭像 發表于 02-16 14:54 ?1263次閱讀
    赌场百家乐官网规则| 现金百家乐官网代理| 玩百家乐请高手指点| 百家乐推荐| 海门市| 澳门百家乐出千| 百家乐送1000| 博狗足球开户| 百家乐官网博彩策略| 百家乐官网java| 迷你百家乐的玩法技巧和规则 | 威尼斯人| 百家乐官网贴| 老人头百家乐的玩法技巧和规则| 博客| 宝博百家乐娱乐城| 辽阳县| 至尊百家乐节目单| 福清市| 百家乐注册18元体验金| 虎林市| 上市百家乐.评论| 网上百家乐大赢家筹码| 百家乐官网冯式打法| 百家乐官网和的打法| 深圳百家乐的玩法技巧和规则| 百家乐官网视频桌球| 澳门百家乐打缆| 百家乐怎么玩| 百家乐电脑游戏高手| 百家乐官网筹码样式| 百家乐赌场怎么玩| 在线棋牌| 新2百家乐娱乐城| 博威娱乐在线| 请问下百家乐官网去哪个娱乐城玩最好呢 | 大荔县| 678百家乐博彩娱乐网| 百家乐官网多少点数算赢| 哪个百家乐玩法平台信誉好 | 真人百家乐官网信誉|