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

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 13784|回復: 14
收起左側

整理后的mpu6050 dmp文件,包括6050驅動代碼(讀取DMP輸出的三個角)

  [復制鏈接]
ID:219263 發表于 2018-1-26 16:23 | 顯示全部樓層 |閱讀模式
main函數，初始化時鐘串口等，執行MPU6050Test();后 while（i）{ReadGYRO（）}就能讀取DMP輸出的三個角

0.png

單片機源程序如下:
  1. #include "mpu6050.h"

  3. #define delay_ms(x)  DelayMs(x)

  5. void MPU6050Test(void)
  6. {
  7.                 int FLAG;

  9.                 do
  10.                 {
  11.                         FLAG=MPU_Init();        //初始化MPU6050, PC0,PC1
  12.                         delay_ms (200);
  13.                         printf ("Waiting...\n");
  14.       if(FLAG)
  15.                                 printf("ErrorMPU6050：%d...\t\n",FLAG);
  16.                 }while(FLAG);
  17.                 do
  18.                 {
  19.                         FLAG=mpu_dmp_init();
  20.                         delay_ms (200);
  21.                           if(FLAG)
  22.       printf("ErrorDMP：%d...\t\n",FLAG);
  23.                 }while(FLAG);
  24.                 printf("MPU6050 DMP Int... \t\n");
  25. }
  26. float anger[3];
  27. void ReadGYRO()
  28. {                       
  29.         float loop_time_200hz=Get_Cycle_T(0);
  30.         //TDT_IMUBotupdate(0.05,Gyroy);
  31.        

  33.                
  34.                 //        MPU_Get_Accelerometer(&Gyroy->aaceleration[X],&Gyroy->aaceleration[Y],&Gyroy->aaceleration[Z]);        //得到加速度傳感器數據
  35.                 //        MPU_Get_Gyroscope(&Gyroy->gyro[X],&Gyroy->gyro[Y],&Gyroy->gyro[Z]);        //得到陀螺儀數據
  36.         MPU_Get_Accelerometer(&Gyroy->OriginalAace[0],&Gyroy->OriginalAace[1],&Gyroy->OriginalAace[2]);
  37.         MPU_Get_Gyroscope(&Gyroy->OriginalGyroys[0],&Gyroy->OriginalGyroys[1],&Gyroy->OriginalGyroys[2]);
  38.                         for(int i=0;i<3;i++)
  39.                         {
  40.                                 mpu9250filter.acc.origin [i]  =Gyroy->OriginalAace[i];
  41.                                 mpu9250filter.gyro.origin [i]  =Gyroy->OriginalGyroys[i];
  42.                         }
  43.                         Mpu9250Top_Data_Prepare();
  44.                         TDT_update(0.5f *loop_time_200hz);
  45.                  printf("dmp=%d\n",mpu_dmp_get_data(&anger[0],&anger[1],&anger[2]));
  46. //        float T_IMU=Get_Cycle_T(0);
  47. //        //TDT_IMUBotupdate(0.05,Gyroy);
  48. //       


  51. //                        if(mpu_dmp_get_data(&anger[0],&anger[1],&anger[2])==0)
  52. //                {
  53. //                //        MPU_Get_Accelerometer(&Gyroy->aaceleration[X],&Gyroy->aaceleration[Y],&Gyroy->aaceleration[Z]);        //得到加速度傳感器數據
  54. //                //        MPU_Get_Gyroscope(&Gyroy->gyro[X],&Gyroy->gyro[Y],&Gyroy->gyro[Z]);        //得到陀螺儀數據
  55. //        MPU_Get_Accelerometer(&Gyroy->OriginalAace[0],&Gyroy->OriginalAace[1],&Gyroy->OriginalAace[2]);
  56. //        MPU_Get_Gyroscope(&Gyroy->OriginalGyroys[0],&Gyroy->OriginalGyroys[1],&Gyroy->OriginalGyroys[2]);
  57. //                }
  58. }
  59. //初始化MPU6050
  60. //返回值:0,成功
  61. //    其他,錯誤代碼
  62. u8 MPU_Init(void)
  63. {
  64.         u8 res;
  65.         IIC_Init();//初始化IIC總線
  66.         MPU_Write_Byte(MPU_PWR_MGMT1_REG,0X80);        //復位MPU6050
  67.     delay_ms(100);
  68.         MPU_Write_Byte(MPU_PWR_MGMT1_REG,0X00);        //喚醒MPU6050
  69.         MPU_Set_Gyro_Fsr(3);                                        //陀螺儀傳感器,±2000dps
  70.         MPU_Set_Accel_Fsr(0);                                        //加速度傳感器,±2g
  71.         MPU_Set_Rate(50);                                                //設置采樣率50Hz
  72.         MPU_Write_Byte(MPU_INT_EN_REG,0X00);        //關閉所有中斷
  73.         MPU_Write_Byte(MPU_USER_CTRL_REG,0X00);        //I2C主模式關閉
  74.         MPU_Write_Byte(MPU_FIFO_EN_REG,0X00);        //關閉FIFO
  75.         MPU_Write_Byte(MPU_INTBP_CFG_REG,0X80);        //INT引腳低電平有效
  76.         res=MPU_Read_Byte(MPU_DEVICE_ID_REG);
  77.         if(res==MPU_ADDR)//器件ID正確
  78.         {
  79.                 MPU_Write_Byte(MPU_PWR_MGMT1_REG,0X01);        //設置CLKSEL,PLL X軸為參考
  80.                 MPU_Write_Byte(MPU_PWR_MGMT2_REG,0X00);        //加速度與陀螺儀都工作
  81.                 MPU_Set_Rate(50);                                                //設置采樣率為50Hz
  82.         }else return 1;
  83.         return 0;
  84. }
  85. //設置MPU6050陀螺儀傳感器滿量程范圍
  86. //fsr:0,±250dps;1,±500dps;2,±1000dps;3,±2000dps
  87. //返回值:0,設置成功
  88. //    其他,設置失敗
  89. u8 MPU_Set_Gyro_Fsr(u8 fsr)
  90. {
  91.         return MPU_Write_Byte(MPU_GYRO_CFG_REG,fsr<<3);//設置陀螺儀滿量程范圍  
  92. }
  93. //設置MPU6050加速度傳感器滿量程范圍
  94. //fsr:0,±2g;1,±4g;2,±8g;3,±16g
  95. //返回值:0,設置成功
  96. //    其他,設置失敗
  97. u8 MPU_Set_Accel_Fsr(u8 fsr)
  98. {
  99.         return MPU_Write_Byte(MPU_ACCEL_CFG_REG,fsr<<3);//設置加速度傳感器滿量程范圍  
  100. }
  101. //設置MPU6050的數字低通濾波器
  102. //lpf:數字低通濾波頻率(Hz)
  103. //返回值:0,設置成功
  104. //    其他,設置失敗
  105. u8 MPU_Set_LPF(u16 lpf)
  106. {
  107.         u8 data=0;
  108.         if(lpf>=188)data=1;
  109.         else if(lpf>=98)data=2;
  110.         else if(lpf>=42)data=3;
  111.         else if(lpf>=20)data=4;
  112.         else if(lpf>=10)data=5;
  113.         else data=6;
  114.         return MPU_Write_Byte(MPU_CFG_REG,data);//設置數字低通濾波器  
  115. }
  116. //設置MPU6050的采樣率(假定Fs=1KHz)
  117. //rate:4~1000(Hz)
  118. //返回值:0,設置成功
  119. //    其他,設置失敗
  120. u8 MPU_Set_Rate(u16 rate)
  121. {
  122.         u8 data;
  123.         if(rate>1000)rate=1000;
  124.         if(rate<4)rate=4;
  125.         data=1000/rate-1;
  126.         data=MPU_Write_Byte(MPU_SAMPLE_RATE_REG,data);        //設置數字低通濾波器
  127.         return MPU_Set_LPF(rate/2);        //自動設置LPF為采樣率的一半
  128. }

  130. //得到溫度值
  131. //返回值:溫度值(擴大了100倍)
  132. short MPU_Get_Temperature(void)
  133. {
  134.     u8 buf[2];
  135.     short raw;
  136.         float temp;
  137.         MPU_Read_Len(MPU_ADDR,MPU_TEMP_OUTH_REG,2,buf);
  138.     raw=((u16)buf[0]<<8)|buf[1];  
  139.     temp=36.53+((double)raw)/340;  
  140.     return temp*100;;
  141. }
  142. //得到陀螺儀值(原始值)
  143. //gx,gy,gz:陀螺儀x,y,z軸的原始讀數(帶符號)
  144. //返回值:0,成功
  145. //    其他,錯誤代碼
  146. u8 MPU_Get_Gyroscope(short *gx,short *gy,short *gz)
  147. {
  148.     u8 buf[6],res;  
  149.         res=MPU_Read_Len(MPU_ADDR,MPU_GYRO_XOUTH_REG,6,buf);
  150.         if(res==0)
  151.         {
  152.                 *gx=((u16)buf[0]<<8)|buf[1];  
  153.                 *gy=((u16)buf[2]<<8)|buf[3];  
  154.                 *gz=((u16)buf[4]<<8)|buf[5];

  156.         }        

  158.     return res;;
  159. }
  160. //得到加速度值(原始值)
  161. //gx,gy,gz:陀螺儀x,y,z軸的原始讀數(帶符號)
  162. //返回值:0,成功
  163. //    其他,錯誤代碼
  164. u8 MPU_Get_Accelerometer(short *ax,short *ay,short *az)
  165. {
  166.     u8 buf[6],res;  
  167.         res=MPU_Read_Len(MPU_ADDR,MPU_ACCEL_XOUTH_REG,6,buf);
  168.         if(res==0)
  169.         {
  170.                 *ax=((u16)buf[0]<<8)|buf[1];  
  171.                 *ay=((u16)buf[2]<<8)|buf[3];  
  172.                 *az=((u16)buf[4]<<8)|buf[5];
  173.         }        
  174.     return res;;
  175. }
  176. //IIC連續寫
  177. //addr:器件地址
  178. //reg:寄存器地址
  179. //len:寫入長度
  180. //buf:數據區
  181. //返回值:0,正常
  182. //    其他,錯誤代碼
  183. u8 MPU_Write_Len(u8 addr,u8 reg,u8 len,u8 *buf)
  184. {
  185.         u8 i;
  186.     IIC_Start();
  187.         IIC_Send_Byte((addr<<1)|0);//發送器件地址+寫命令       
  188.         if(IIC_Wait_Ack())        //等待應答
  189.         {
  190.                 IIC_Stop();                 
  191.                 return 1;               
  192.         }
  193.     IIC_Send_Byte(reg);        //寫寄存器地址
  194.     IIC_Wait_Ack();                //等待應答
  195.         for(i=0;i<len;i++)
  196.         {
  197.                 IIC_Send_Byte(buf[i]);        //發送數據
  198.                 if(IIC_Wait_Ack())                //等待ACK
  199.                 {
  200.                         IIC_Stop();         
  201.                         return 1;                 
  202.                 }               
  203.         }   
  204.     IIC_Stop();         
  205.         return 0;       
  206. }
  207. //IIC連續讀
  208. //addr:器件地址
  209. //reg:要讀取的寄存器地址
  210. //len:要讀取的長度
  211. //buf:讀取到的數據存儲區
  212. //返回值:0,正常
  213. //    其他,錯誤代碼
  214. u8 MPU_Read_Len(u8 addr,u8 reg,u8 len,u8 *buf)
  215. {
  216.         IIC_Start();
  217.         IIC_Send_Byte((addr<<1)|0);//發送器件地址+寫命令       
  218.         if(IIC_Wait_Ack())        //等待應答
  219.         {
  220.                 IIC_Stop();                 
  221.                 return 1;               
  222.         }
  223.     IIC_Send_Byte(reg);        //寫寄存器地址
  224.     IIC_Wait_Ack();                //等待應答
  225.     IIC_Start();
  226.         IIC_Send_Byte((addr<<1)|1);//發送器件地址+讀命令       
  227.     IIC_Wait_Ack();                //等待應答
  228.         while(len)
  229.         {
  230.                 if(len==1)*buf=IIC_Read_Byte(0);//讀數據,發送nACK
  231.                 else *buf=IIC_Read_Byte(1);                //讀數據,發送ACK  
  232.                 len--;
  233.                 buf++;
  234.         }   
  235.     IIC_Stop();        //產生一個停止條件
  236.         return 0;       
  237. }
  238. //IIC寫一個字節
  239. //reg:寄存器地址
  240. //data:數據
  241. //返回值:0,正常
  242. //    其他,錯誤代碼
  243. u8 MPU_Write_Byte(u8 reg,u8 data)                                  
  244. {
  245.     IIC_Start();
  246.         IIC_Send_Byte((MPU_ADDR<<1)|0);//發送器件地址+寫命令       
  247.         if(IIC_Wait_Ack())        //等待應答
  248.         {
  249.                 IIC_Stop();                 
  250.                 return 1;               
  251.         }
  252.     IIC_Send_Byte(reg);        //寫寄存器地址
  253.     IIC_Wait_Ack();                //等待應答
  254.         IIC_Send_Byte(data);//發送數據
  255.         if(IIC_Wait_Ack())        //等待ACK
  256.         {
  257.                 IIC_Stop();         
  258.                 return 1;                 
  259.         }                 
  260.     IIC_Stop();         
  261.         return 0;
  262. }
  263. //IIC讀一個字節
  264. //reg:寄存器地址
  265. //返回值:讀到的數據
  266. u8 MPU_Read_Byte(u8 reg)
  267. {
  268.         u8 res;
  269.     IIC_Start();
  270.         IIC_Send_Byte((MPU_ADDR<<1)|0);//發送器件地址+寫命令       
  271.         IIC_Wait_Ack();                //等待應答
  272.     IIC_Send_Byte(reg);        //寫寄存器地址
  273.     IIC_Wait_Ack();                //等待應答
  274.     IIC_Start();
  275.         IIC_Send_Byte((MPU_ADDR<<1)|1);//發送器件地址+讀命令       
  276.     IIC_Wait_Ack();                //等待應答
  277.         res=IIC_Read_Byte(0);//讀取數據,發送nACK
  278.     IIC_Stop();                        //產生一個停止條件
  279.         return res;               
  280. }
復制代碼

所有資料51hei提供下載:
MPU6050 DMP.zip (43.69 KB, 下載次數: 251)
回復

使用道具 舉報

ID:284626 發表于 2018-5-5 18:18 | 顯示全部樓層
main.C呢！！！！！
回復

使用道具 舉報

ID:324874 發表于 2018-5-18 21:41 | 顯示全部樓層
謝謝分享，學習一下
回復

使用道具 舉報

ID:152785 發表于 2018-7-18 10:00 | 顯示全部樓層
兄弟,這個你試過嗎?確定能行?指導下唄
回復

使用道具 舉報

ID:327894 發表于 2018-8-6 10:17 | 顯示全部樓層
謝謝分享
回復

使用道具 舉報

ID:327894 發表于 2018-8-6 10:18 | 顯示全部樓層
樓主用的是什么芯片啊
回復

使用道具 舉報

ID:383347 發表于 2018-8-6 10:35 | 顯示全部樓層
頂一個
回復

使用道具 舉報

ID:388317 發表于 2018-8-20 22:51 | 顯示全部樓層
感謝分享！
回復

使用道具 舉報

ID:336044 發表于 2018-9-12 14:24 | 顯示全部樓層
不會用
回復

使用道具 舉報

ID:229577 發表于 2018-12-4 10:56 | 顯示全部樓層
這明顯不是dmp呀, 坑貨
回復

使用道具 舉報

ID:576259 發表于 2019-7-2 11:13 | 顯示全部樓層
樓主厲害
回復

使用道具 舉報

ID:384844 發表于 2019-7-20 18:39 | 顯示全部樓層
謝謝分享
回復

使用道具 舉報

ID:185372 發表于 2019-10-7 07:53 | 顯示全部樓層
這個能使用dmp庫嗎？遇到錯誤了。希望這個會有用。
回復

使用道具 舉報

ID:670179 發表于 2019-12-22 07:55 | 顯示全部樓層
正常感謝！文件不全
回復

使用道具 舉報

ID:349536 發表于 2020-5-7 19:10 | 顯示全部樓層
樓主，你的代碼沒有main()函數呀，而且只有官方dmp的幾個文件，不是工程文件要怎么用呢求源工程文件！
回復

使用道具 舉報

您需要登錄后才可以回帖 登錄 | 立即注冊

本版積分規則

手機版|小黑屋|51黑電子論壇 |51黑電子論壇6群 QQ 管理員QQ:125739409;技術交流QQ群281945664

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板： 毛片视频网站 | 成人精品在线视频 | 国产一区二区三区四区 | 国产1区2区在线观看 | 国产在线一区二区 | 亚洲日产精品 | 黄免费观看 | 99re在线视频精品 | 欧美成人免费在线视频 | 美女国内精品自产拍在线播放 | 亚洲精品 在线播放 | 亚洲精品无 | 91免费看片 | 国产精品1区 | 999久久久 | 亚洲精品一区av在线播放 | 欧洲成人免费视频 | 日韩久久久久久 | 久久久久久久香蕉 | 国产午夜精品一区二区三区嫩草 | 91久久精品国产 | 福利视频网址 | 日韩中文久久 | 中文字幕在线观看一区二区 | 国产成人精品999在线观看 | 久久久久久免费精品一区二区三区 | 蜜月va乱码一区二区三区 | 免费国产黄 | 国产精品久久久久久久免费大片 | 日韩精彩视频 | 久久只有精品 | 国产精品久久免费观看 | 久久久久亚洲精品 | 黄色片网站在线观看 | 久久精品视频一区二区三区 | 国产精品视频一二三区 | 国产精品免费一区二区三区四区 | 日韩一区二 | 国产一级特黄视频 | 一区二区av | 亚洲网站在线观看 |