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

標題: HT32F52352DMP單片機讀取MPU9250數據源程序 [打印本頁]
作者: iron_001    時間: 2021-4-2 12:17
標題: HT32F52352DMP單片機讀取MPU9250數據源程序
單片機源程序如下:
  1. #include "ht32.h"
  2. #include "ht32_board.h"
  3. #include "usart_int.h"
  4. #include <string.h>
  5. #include "usart.h"
  6. #include "./IMU901/ringbuffer.h"
  7. #include "./IMU901/imu901.h"
  8. #include "delay.h"
  9. #include "motor.h"
  10. #include "NRF24L01.h"
  11. #include "usart1.h"
  12. #include "ANO_DT.h"
  13. #include "pid.h"
  14. #include "mpu9250.h"
  15. #include "inv_mpu.h"
  16. #include "inv_mpu_dmp_motion_driver.h"
  17. #include "stdio.h"

  19. /*
  20.   1號電機 30解鎖 31-40  占空比        372-480
  21.         3號電機 30解鎖 31-40  占空比        372-480
  22.         2號電機 18解鎖 19-34  占空比        228-408
  23.         4號電機 18解鎖 21-39  占空比        252-468
  24.         
  25. */
  26. u8 tmp_buf[33]= "hello";
  27. u8  k;
  28.                 float mpu_pitch,mpu_roll,mpu_yaw;         //歐拉角
  29.         short aacx,aacy,aacz;        //加速度傳感器原始數據
  30.         short gyrox,gyroy,gyroz;//陀螺儀原始數據
  31.         short temp;                        //溫度

  33. #define   Key1       1<<8       //Key1=PA8
  34. #define   Key2       1<<13       //Key2=PC13
  35. #define   Key1_DIR   {  HT_GPIOA->INER |= HT_GPIOA->PUR |= Key1;}  //Key1塊の矗ど筿
  36. #define   Key2_DIR   { HT_GPIOC->INER |= HT_GPIOC->PUR |= Key2;}  //Key2塊の矗ど筿

  38. #define   Key1_0    !(HT_GPIOA->DINR & Key1)  //浪琩琌齡Key1=0
  39. #define   Key1_1     HT_GPIOA->DINR & Key1    //浪琩琌齡Key1=1

  41. #define   Key2_0    !(HT_GPIOC->DINR & Key2)   //浪琩琌齡Key2=0
  42. #define   Key2_1     HT_GPIOC->DINR & Key2    //浪琩琌齡Key2=1

  44. void Key_Init(void)
  45. {
  46.         HT_CKCU->AHBCCR |= 1<<16;
  47.         HT_CKCU->AHBCCR |= 1<<18;
  48.   Key1_DIR
  49.         Key2_DIR
  50. }        

  52. int main(void)
  53. {
  54.   static u8  t =23;

  56. //  u8  buff[20];        
  57.         
  58.         //NRF24L01_Init();
  59.   USART0_Configuration(256000);            //USART0的初始化,波特率為460800
  60. //        printf("OK\n");
  61. ////        ringbuffer_init(&usart0RxFifo, (uint8_t*)buff, 256);   //FIFO結構體的初始化
  62.   UART0_Configuration(115200);
  63. //  PWM_Init();
  64. //  Key_Init();
  65. ////  unlocked();

  67. ////        delay_ms(500);
  68. ////        delay_ms(500);
  69. ////        delay_ms(500);
  70. ////        delay_ms(500);
  71.    MPU_Init();                     //初始化MPU9250
  72. //                if(NRF24L01_Check()==0)  
  73. //        {

  75. //        }

  77.         if(mpu_dmp_init())
  78.         {

  80.         }
  81.         


  84. //  NRF24L01_TX_Mode();
  85.   while (1)
  86.   {

  88. //    Data_Send_To_PC();
  89.                 delay_ms(5);               

  91. //                Angle_PWM(attitude.pitch,attitude.roll,attitude.yaw);
  92.                 Angle_PWM(mpu_pitch,mpu_roll,mpu_yaw);

  94.     t++;
  95.                 if(t == 100)
  96.                 {
  97. //                          HT32F_DVB_LEDToggle(HT_LED1);
  98. //        HT32F_DVB_LEDToggle(HT_LED2);
  99.                         
  100.                 }
  101.           if(mpu_mpl_get_data(&mpu_pitch,&mpu_roll,&mpu_yaw)==0)
  102.     {
  103.                         
  104.       temp=MPU_Get_Temperature();        //得到溫度值
  105.                         MPU_Get_Accelerometer(&aacx,&aacy,&aacz);        //得到加速度傳感器數據
  106.                         MPU_Get_Gyroscope(&gyrox,&gyroy,&gyroz);        //得到陀螺儀數據
  107.                         printf("x:%f,y:%f,z:%f\n",mpu_pitch,mpu_roll,mpu_yaw);
  108.                                                                                          HT32F_DVB_LEDInit(HT_LED2);
  109.           HT32F_DVB_LEDOn(HT_LED2);
  110.                 }
  111.   }
  112. }
復制代碼

所有代碼51hei提供下載:
MPU9250DMP.7z (611.51 KB, 下載次數: 12)






歡迎光臨 (http://m.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板： 久久久久久亚洲精品 | 毛片网站免费观看 | 亚洲 欧美 另类 综合 偷拍 | 秋霞a级毛片在线看 | 99pao成人国产永久免费视频 | 天天操 天天操 | 少妇黄色 | 日韩国产免费 | 精品久久久久久久 | 成人免费视频一区二区 | 91精品国产乱码麻豆白嫩 | 精品欧美一区二区精品久久久 | 亚洲精品免费视频 | 久久久.com | 亚洲综合二区 | 国产激情一区二区三区 | 日本成人在线免费视频 | 亚洲视频区 | 毛片网在线观看 | 国产视频久久 | www.亚洲一区 | 成人自拍av | 国产在线拍偷自揄拍视频 | jizz中国日本 | 91污在线 | 超碰最新在线 | 久草a√ | 激情欧美一区二区三区 | 中文字幕一区二区在线观看 | 亚洲欧美一区二区三区在线 | 91在线精品秘密一区二区 | 天天躁人人躁人人躁狂躁 | 精品91久久久 | 国产传媒在线观看 | 国产精品99久久久久久久久久久久 | 99久久国产精 | 久久国产精彩视频 | 中文字幕精品一区二区三区精品 | 国产精品亚洲一区 | 亚洲精品成人 | 第四色影音先锋 |