標(biāo)題: 通過stm32cubemax完成配置，與mpu6050通信兵讀取數(shù)據(jù)，將數(shù)據(jù)通過串口打印出來 [打印本頁]
作者: swy123    時(shí)間: 2020-7-22 23:28
標(biāo)題: 通過stm32cubemax完成配置，與mpu6050通信兵讀取數(shù)據(jù)，將數(shù)據(jù)通過串口打印出來
通過stm32cubemax完成配置，與mpu6050通信并讀取數(shù)據(jù)，將數(shù)據(jù)通過串口打印出來

單片機(jī)源程序如下:
  1. /* USER CODE END Header */

  3. /* Includes ------------------------------------------------------------------*/
  4. #include "main.h"
  5. #include "i2c.h"
  6. #include "stm32f4xx_hal.h"
  7. #include "usart.h"
  8. #include "gpio.h"
  9. #include "stdio.h"

  11. /* Private includes ----------------------------------------------------------*/
  12. #include "inv_mpu.h"
  13. #include "inv_mpu_dmp_motion_driver.h"
  14. #include <math.h>
  15. #define ADDRESS_W 0xD0   //寫地址 0x68
  16. #define ADDRESS_R 0xD1   //讀地址  0x69
  17. #define MPU_PWR_MGMT1_REG                0X6B        //電源管理寄存器1
  18. #define MPU_GYRO_CFG_REG                0X1B        //陀螺儀配置寄存器
  19. #define MPU_ACCEL_CFG_REG                0X1C        //加速度計(jì)配置寄存器
  20. #define MPU_SAMPLE_RATE_REG                0X19        //陀螺儀采樣頻率分頻器
  21. #define MPU_INT_EN_REG                        0X38        //中斷使能寄存器
  22. #define MPU_USER_CTRL_REG                0X6A        //用戶控制寄存器
  23. #define MPU_FIFO_EN_REG                        0X23        //FIFO使能寄存器
  24. #define MPU_INTBP_CFG_REG                0X37        //中斷/旁路設(shè)置寄存器
  25. #define MPU_DEVICE_ID_REG                0X75        //器件ID寄存器
  26. #define MPU_PWR_MGMT2_REG                0X6C        //電源管理寄存器2
  27. #define MPU_CFG_REG                                0X1A        //配置寄存器 低通濾波器配置寄存器
  28. #define MPU_TEMP_OUTH_REG                0X41        //溫度值高八位寄存器
  29. #define MPU_TEMP_OUTL_REG                0X42        //溫度值低8位寄存器

  31. #define MPU_ACCEL_XOUTH_REG                0X3B        //加速度值,X軸高8位寄存器
  32. #define MPU_ACCEL_XOUTL_REG                0X3C        //加速度值,X軸低8位寄存器
  33. #define MPU_ACCEL_YOUTH_REG                0X3D        //加速度值,Y軸高8位寄存器
  34. #define MPU_ACCEL_YOUTL_REG                0X3E        //加速度值,Y軸低8位寄存器
  35. #define MPU_ACCEL_ZOUTH_REG                0X3F        //加速度值,Z軸高8位寄存器
  36. #define MPU_ACCEL_ZOUTL_REG                0X40        //加速度值,Z軸低8位寄存器

  38. #define MPU_GYRO_XOUTH_REG                0X43        //陀螺儀值,X軸高8位寄存器
  39. #define MPU_GYRO_XOUTL_REG                0X44        //陀螺儀值,X軸低8位寄存器
  40. #define MPU_GYRO_YOUTH_REG                0X45        //陀螺儀值,Y軸高8位寄存器
  41. #define MPU_GYRO_YOUTL_REG                0X46        //陀螺儀值,Y軸低8位寄存器
  42. #define MPU_GYRO_ZOUTH_REG                0X47        //陀螺儀值,Z軸高8位寄存器
  43. #define MPU_GYRO_ZOUTL_REG                0X48        //陀螺儀值,Z軸低8位寄存器

  45. //定義輸出速度
  46. #define DEFAULT_MPU_HZ  (100)                //100Hz

  48. //q30格式,long轉(zhuǎn)float時(shí)的除數(shù).
  49. #define q30  1073741824.0f
  50. /* USER CODE END Includes */

  52. /* Private typedef -----------------------------------------------------------*/
  53. /* USER CODE BEGIN PTD */

  55. /* USER CODE END PTD */

  57. /* Private define ------------------------------------------------------------*/

  59. /* USER CODE BEGIN PD */

  61. /* USER CODE END PD */

  63. /* Private macro -------------------------------------------------------------*/
  64. /* USER CODE BEGIN PM */

  66. /* USER CODE END PM */

  68. /* Private variables ---------------------------------------------------------*/
  69. void MPU_6050_Init(void);
  70. unsigned char  MPU_Set_LPF(unsigned short lpf);
  71. //DMP庫需要的函數(shù)
  72. unsigned char HAL_i2c_write(unsigned char slave_addr, unsigned char reg_addr, unsigned char length, unsigned char const *data);
  73. unsigned char HAL_i2c_read(unsigned char slave_addr, unsigned char reg_addr, unsigned char length, unsigned char const *data);
  74. //讀取 溫度傳感器   陀螺儀  加速度數(shù)據(jù)
  75. void read_all(void);
  76. //陀螺儀方向控制
  77. unsigned short inv_orientation_matrix_to_scalar(const signed char *mtx);
  78. //方向轉(zhuǎn)換
  79. unsigned short inv_row_2_scale(const signed char *row);
  80. //MPU6050自測(cè)試
  81. //返回值:0,正常
  82. //    其他,失敗
  83. unsigned char run_self_test(void);
  84. //mpu6050,dmp初始化
  85. //返回值:0,正常
  86. //    其他,失敗
  87. unsigned char mpu_dmp_init(void);
  88. //得到dmp處理后的數(shù)據(jù)(注意,本函數(shù)需要比較多堆棧,局部變量有點(diǎn)多)
  89. //pitch:俯仰角 精度:0.1°   范圍:-90.0° <---> +90.0°
  90. //roll:橫滾角  精度:0.1°   范圍:-180.0°<---> +180.0°
  91. //yaw:航向角   精度:0.1°   范圍:-180.0°<---> +180.0°
  92. //返回值:0,正常
  93. //    其他,失敗
  94. unsigned char mpu_dmp_get_data(float *pitch,float *roll,float *yaw);
  95. /* USER CODE BEGIN PV */

  97. /* USER CODE END PV */

  99. /* Private function prototypes -----------------------------------------------*/
  100. void SystemClock_Config(void);
  101. /* USER CODE BEGIN PFP */

  103. /* USER CODE END PFP */

  105. /* Private user code ---------------------------------------------------------*/
  106. /* USER CODE BEGIN 0 */
  107. static signed char gyro_orientation[9] = { 1, 0, 0,
  108.                                            0, 1, 0,
  109.                                            0, 0, 1};

  111. float pitch,roll,yaw;                 //歐拉角
  112. //串口1發(fā)送1個(gè)字符
  113. //c:要發(fā)送的字符
  114. void usart1_send_char(uint8_t c)
  115. {
  116.     while(__HAL_UART_GET_FLAG(&huart1,UART_FLAG_TC)==RESET){};
  117.     USART1->DR=c;  
  118. }

  120. //傳送數(shù)據(jù)給匿名四軸上位機(jī)軟件(V2.6版本)
  121. //fun:功能字. 0X01~0X1C
  122. //data:數(shù)據(jù)緩存區(qū),最多28字節(jié)!!
  123. //len:data區(qū)有效數(shù)據(jù)個(gè)數(shù)
  124. void usart1_niming_report(uint8_t fun,uint8_t*data,uint8_t len)
  125. {
  126.         uint8_t send_buf[32];
  127.         uint8_t i;
  128.         if(len>28)return;        //最多28字節(jié)數(shù)據(jù)
  129.         send_buf[len+3]=0;        //校驗(yàn)數(shù)置零
  130.         send_buf[0]=0XAA;        //幀頭
  131.         send_buf[1]=0XAA;        //幀頭
  132.         send_buf[2]=fun;        //功能字
  133.         send_buf[3]=len;        //數(shù)據(jù)長度
  134.         for(i=0;i<len;i++)send_buf[4+i]=data[i];                        //復(fù)制數(shù)據(jù)
  135.         for(i=0;i<len+4;i++)send_buf[len+4]+=send_buf[i];        //計(jì)算校驗(yàn)和       
  136.         for(i=0;i<len+5;i++)usart1_send_char(send_buf[i]);        //發(fā)送數(shù)據(jù)到串口1
  137. }
  138. //發(fā)送加速度傳感器數(shù)據(jù)+陀螺儀數(shù)據(jù)(傳感器幀)
  139. //aacx,aacy,aacz:x,y,z三個(gè)方向上面的加速度值
  140. //gyrox,gyroy,gyroz:x,y,z三個(gè)方向上面的陀螺儀值
  141. void mpu6050_send_data(short aacx,short aacy,short aacz,short gyrox,short gyroy,short gyroz)
  142. {
  143.         uint8_t tbuf[18];
  144.         tbuf[0]=(aacx>>8)&0XFF;
  145.         tbuf[1]=aacx&0XFF;
  146.         tbuf[2]=(aacy>>8)&0XFF;
  147.         tbuf[3]=aacy&0XFF;
  148.         tbuf[4]=(aacz>>8)&0XFF;
  149.         tbuf[5]=aacz&0XFF;
  150.         tbuf[6]=(gyrox>>8)&0XFF;
  151.         tbuf[7]=gyrox&0XFF;
  152.         tbuf[8]=(gyroy>>8)&0XFF;
  153.         tbuf[9]=gyroy&0XFF;
  154.         tbuf[10]=(gyroz>>8)&0XFF;
  155.         tbuf[11]=gyroz&0XFF;
  156.         tbuf[12]=0;//因?yàn)殚_啟MPL后,無法直接讀取磁力計(jì)數(shù)據(jù),所以這里直接屏蔽掉.用0替代.
  157.         tbuf[13]=0;
  158.         tbuf[14]=0;
  159.         tbuf[15]=0;
  160.         tbuf[16]=0;
  161.         tbuf[17]=0;
  162.         usart1_niming_report(0X02,tbuf,18);//傳感器幀,0X02
  163. }       
  164. //通過串口1上報(bào)結(jié)算后的姿態(tài)數(shù)據(jù)給電腦(狀態(tài)幀)
  165. //roll:橫滾角.單位0.01度。 -18000 -> 18000 對(duì)應(yīng) -180.00  ->  180.00度
  166. //pitch:俯仰角.單位 0.01度。-9000 - 9000 對(duì)應(yīng) -90.00 -> 90.00 度
  167. //yaw:航向角.單位為0.1度 0 -> 3600  對(duì)應(yīng) 0 -> 360.0度
  168. //csb:超聲波高度,單位:cm
  169. //prs:氣壓計(jì)高度,單位:mm
  170. void usart1_report_imu(short roll,short pitch,short yaw,short csb,int prs)
  171. {
  172.         uint8_t tbuf[12];          
  173.         tbuf[0]=(roll>>8)&0XFF;
  174.         tbuf[1]=roll&0XFF;
  175.         tbuf[2]=(pitch>>8)&0XFF;
  176.         tbuf[3]=pitch&0XFF;
  177.         tbuf[4]=(yaw>>8)&0XFF;
  178.         tbuf[5]=yaw&0XFF;
  179.         tbuf[6]=(csb>>8)&0XFF;
  180.         tbuf[7]=csb&0XFF;
  181.         tbuf[8]=(prs>>24)&0XFF;
  182.         tbuf[9]=(prs>>16)&0XFF;
  183.         tbuf[10]=(prs>>8)&0XFF;
  184.         tbuf[11]=prs&0XFF;
  185.         usart1_niming_report(0X01,tbuf,12);//狀態(tài)幀,0X01
  186. }                                                                                    

  188. /* USER CODE END 0 */

  190. /**
  191.   * @brief  The application entry point.
  192.   * @retval int
  193.   */
  194. int main(void)
  195. {
  196.   /* USER CODE BEGIN 1 */
  197.         unsigned char DMP_INT_FLAG=0;
  198.         unsigned char rev_flag=0;
  199.   /* USER CODE END 1 */
  200.   

  202.   /* MCU Configuration--------------------------------------------------------*/

  204.   /* Reset of all peripherals, Initializes the Flash interface and the Systick. */
  205.   HAL_Init();

  207.   /* USER CODE BEGIN Init */

  209.   /* USER CODE END Init */

  211.   /* Configure the system clock */
  212.   SystemClock_Config();

  214.   /* USER CODE BEGIN SysInit */

  216.   /* USER CODE END SysInit */

  218.   /* Initialize all configured peripherals */
  219.   MX_GPIO_Init();
  220.   MX_I2C3_Init();
  221.   MX_USART1_UART_Init();
  222.   /* USER CODE BEGIN 2 */
  223.   HAL_Delay(5000);
  224.         printf("MPU6050test\n");
  225.         MPU_6050_Init();// 可以嘗試 直接打開FIFO
  226.         //初始化DMP
  227.         DMP_INT_FLAG=mpu_dmp_init();
  228.         printf("DMP_INT_FLAG %d \n",DMP_INT_FLAG);
  229.   /* USER CODE END 2 */

  231.   /* Infinite loop */
  232.   /* USER CODE BEGIN WHILE */
  233.   while (1)
  234.   {
  235.                 if((rev_flag=mpu_dmp_get_data(&pitch,&roll,&yaw))==0)
  236.                 {
  237.                         printf("俯仰角 = %.2f\r\n",pitch);
  238.                         printf("偏航角 = %.2f\r\n",roll);
  239.                         printf("翻滾角 = %.2f\r\n",yaw);
  240.                 }
  241. //                else
  242. //                {
  243. //                                printf("rev_flag %d\n",rev_flag);
  244. //                                HAL_Delay(100);//讀取頻率不能太慢 防止FIFO溢出
  245. //                }

  247.           read_all();
  248.           HAL_Delay(100);

  250.     /* USER CODE END WHILE */

  252.     /* USER CODE BEGIN 3 */
  253.   }
  254.   /* USER CODE END 3 */
  255. }

  257. /**
  258.   * @brief System Clock Configuration
  259.   * @retval None
  260.   */
  261. void SystemClock_Config(void)
  262. {
  263.   RCC_OscInitTypeDef RCC_OscInitStruct = {0};
  264.   RCC_ClkInitTypeDef RCC_ClkInitStruct = {0};

  266.   /** Configure the main internal regulator output voltage
  267.   */
  268.   __HAL_RCC_PWR_CLK_ENABLE();
  269.   __HAL_PWR_VOLTAGESCALING_CONFIG(PWR_REGULATOR_VOLTAGE_SCALE1);
  270.   /** Initializes the CPU, AHB and APB busses clocks
  271.   */
  272.   RCC_OscInitStruct.OscillatorType = RCC_OSCILLATORTYPE_HSI;
  273.   RCC_OscInitStruct.HSIState = RCC_HSI_ON;
  274.   RCC_OscInitStruct.HSICalibrationValue = RCC_HSICALIBRATION_DEFAULT;
  275.   RCC_OscInitStruct.PLL.PLLState = RCC_PLL_ON;
  276.   RCC_OscInitStruct.PLL.PLLSource = RCC_PLLSOURCE_HSI;
  277.   RCC_OscInitStruct.PLL.PLLM = 8;
  278.   RCC_OscInitStruct.PLL.PLLN = 96;
  279.   RCC_OscInitStruct.PLL.PLLP = RCC_PLLP_DIV2;
  280.   RCC_OscInitStruct.PLL.PLLQ = 4;
  281.   if (HAL_RCC_OscConfig(&RCC_OscInitStruct) != HAL_OK)
  282.   {
  283.     Error_Handler();
  284.   }
  285.   /** Initializes the CPU, AHB and APB busses clocks
  286.   */
  287.   RCC_ClkInitStruct.ClockType = RCC_CLOCKTYPE_HCLK|RCC_CLOCKTYPE_SYSCLK
  288.                               |RCC_CLOCKTYPE_PCLK1|RCC_CLOCKTYPE_PCLK2;
  289.   RCC_ClkInitStruct.SYSCLKSource = RCC_SYSCLKSOURCE_PLLCLK;
  290.   RCC_ClkInitStruct.AHBCLKDivider = RCC_SYSCLK_DIV1;
  291.   RCC_ClkInitStruct.APB1CLKDivider = RCC_HCLK_DIV2;
  292.   RCC_ClkInitStruct.APB2CLKDivider = RCC_HCLK_DIV1;

  294.   if (HAL_RCC_ClockConfig(&RCC_ClkInitStruct, FLASH_LATENCY_3) != HAL_OK)
  295.   {
  296.     Error_Handler();
  297.   }
  298. }

  300. /* USER CODE BEGIN 4 */
  301. void MPU_6050_Init(void)
  302. ……………………

  304. …………限于本文篇幅 余下代碼請(qǐng)從51黑下載附件…………
復(fù)制代碼

所有資料51hei提供下載:
F411-MPU6050.7z (6.76 MB, 下載次數(shù): 27)





歡迎光臨 (http://www.torrancerestoration.com/bbs/) Powered by Discuz! X3.1