標題: 很全的Leadiy-M3C陀螺儀資料與STM32源程序 [打印本頁]
作者: 十里故清歡    時間: 2018-6-1 22:41
標題: 很全的Leadiy-M3C陀螺儀資料與STM32源程序
希望有更好的可以一起分享上來




單片機源程序如下:
  1. /*********************************
  2. LEADIY-M3測試程序示例V2.2
  3. 作者: Colin
  4. 版權(quán)所有:  深圳市軟芯微電子科技有限公司
  5. 芯片型號:  stm32f103CB
  6. *************************************/

  8. #include "string.h"
  9. #include "stm32f10x.h"
  10. #include "sys.h"
  11. #include "usart.h"
  12. #include "delay.h"
  13. #include "drv_Uart.h"


  16. int16_t Gyro[3], Acc[3], Angle[3], Mag[3];
  17. int32_t Altitude, Pressure;
  18. float Temper, GyroDPS[3], AccG[3], MagGauss[3], AngleDeg[3];


  21. /*讀兩個字節(jié)組成一個16位數(shù)*/
  22. int16_t ReadW(void)
  23. {
  24. unsigned char BufC;
  25. int16_t BufW;
  26.    
  27.   BufC = uartRead();
  28.   BufW = (uint16_t)BufC;
  29.   BufC = uartRead();
  30.   BufW = (int16_t)(((uint16_t)BufC  << 8) | BufW);
  31.   return BufW;
  32. }


  35. int main(void)
  36. {
  37. unsigned char BufC;
  38. uint16_t BufW;

  40.   /* 系統(tǒng)初始化*/
  41.   systemInit();

  43.   delay_ms(300);
  44.   printf("LEADIY-M3 TEST V2\r\n");

  46.   while (1)
  47.   {
  48.     if(uartAvailable()) //檢測是否收到LEADIY-M3數(shù)據(jù)
  49.     {  
  50.       BufC = uartRead(); //讀一個字節(jié)
  51.       if((BufC==0xA7)){  //判斷是否為幀 頭
  52.         BufC = uartRead(); //讀一個字節(jié)
  53.         if (BufC==0x7A) { //判斷是否為幀頭
  54.           BufC = uartRead(); //讀一個字節(jié)
  55.           switch(BufC) //幀類型判斷
  56.           {
  57.             case 0x70: //標識為角速度幀
  58.               BufC = uartRead(); //幀長度，可不用
  59.               BufC = uartRead(); //效驗位
  60.               Gyro[0] = ReadW();      //X軸
  61.               Gyro[1] = ReadW();      //Y軸
  62.               Gyro[2] = ReadW();      //Z軸

  64.               /*GYRO的量程為2000度每秒*/
  65.               /* 得到以"dps" ("度/秒")為單位的角速度值*/
  66.               GyroDPS[0] = (float)Gyro[0]*4/16.4;
  67.               GyroDPS[1] = (float)Gyro[1]*4/16.4;
  68.               GyroDPS[2] = (float)Gyro[2]*4/16.4;

  70.               printf("GYRO X：%d  Y：%d  Z：%d\r\n", Gyro[0], Gyro[1], Gyro[2]);
  71.               printf("GyroDPS X: %.2f, Y: %.2f, Z: %.2f\r\n", GyroDPS[0], GyroDPS[1], GyroDPS[2]);
  72.               break;
  73.             case 0x71: //標識為加速度幀
  74.               BufC = uartRead(); //幀長度，可不用
  75.               BufC = uartRead(); //效驗位
  76.               Acc[0] = ReadW();      //X軸
  77.               Acc[1] = ReadW();      //Y軸
  78.               Acc[2] = ReadW();      //Z軸

  80.               /*ACC的量程為8G*/
  81.               /*得到以"g"為單位的加速度*/
  82.               AccG[0] = (float)Acc[0] / 4096;
  83.               AccG[1] = (float)Acc[1] / 4096;
  84.               AccG[2] = (float)Acc[2] / 4096;
  85.               printf("ACC X：%d  Y：%d  Z：%d\r\n", Acc[0], Acc[1], Acc[2]);
  86.               printf("AccG X：%.2f  Y：%.2f  Z：%.2f\r\n", AccG[0], AccG[1], AccG[2]);
  87.               break;
  88.             case 0x72: //標識為姿態(tài)幀
  89.               BufC = uartRead(); //幀長度，可不用
  90.               BufC = uartRead(); //效驗位
  91.               Angle[0] = ReadW();   //X軸角度(橫滾)
  92.               Angle[1] = ReadW();   //Y軸角度(俯仰)
  93.               Angle[2] = ReadW();   //Z軸角度(偏航)

  95.               AngleDeg[0] = (float)Angle[0] / 100;
  96.               AngleDeg[1] = (float)Angle[1] / 100;
  97.               AngleDeg[2] = (float)Angle[2] / 100;
  98.               if (AngleDeg[2]<0) AngleDeg[2] += 360; //將航向值轉(zhuǎn)化到0---360度區(qū)間
  99.               printf("ANGLE X：%d  Y：%d  Z：%d \r\n", Angle[0], Angle[1], Angle[2]);
  100.               printf("AngleDeg X：%.2f  Y：%.2f  Z：%.2f \r\n", AngleDeg[0], AngleDeg[1], AngleDeg[2]);
  101.               break;
  102.             case 0x73: //標識為 地磁幀
  103.               BufC = uartRead(); //幀長度，可不用
  104.               BufC = uartRead(); //效驗位
  105.               Mag[0] = ReadW();   //X軸
  106.               Mag[1] = ReadW();   //Y軸
  107.               Mag[2] = ReadW();   //Z軸

  109.               /*地磁設(shè)置為2.5Ga*/
  110.               /*得到以"Gauss"為單位的地磁*/
  111.               MagGauss[0] = (float)Mag[0] / 660;
  112.               MagGauss[1] = (float)Mag[1] / 660;
  113.               MagGauss[2] = (float)Mag[2] / 660;
  114.               printf("Mag X：%d  Y：%d  Z：%d \r\n", Mag[0], Mag[1], Mag[2]);
  115.               printf("MagGauss X：%.2f  Y：%.2f  Z：%.2f \r\n", MagGauss[0], MagGauss[1], MagGauss[2]);
  116.               break;
  117.             case 0x74: //標識為溫度、氣壓幀
  118.               BufC = uartRead(); //幀長度，可不用
  119.               BufC = uartRead(); //效驗位
  120.               Temper = ReadW() / 10;   //X軸
  121.               BufW = ReadW();   //氣壓低16位
  122.               Pressure = (int32_t)(((uint32_t)(ReadW() << 16))|BufW);
  123.               printf("Temperature(Degree)：%.2f  Pressure(Pa)：%d \r\n", Temper, Pressure);
  124.               break;
  125.             case 0x75: // 標識為高度幀
  126.               BufC = uartRead(); //幀長度，可不用
  127.               BufC = uartRead(); //效驗位
  128.               BufW = ReadW();   //高度低16位

  130.               /*得到以"CM"為單位的海拔高度*/
  131.               Altitude = (int32_t)(((uint32_t)(ReadW() << 16))|BufW);
  132.               printf("Altitude(cm)：%d \r\n", Altitude);
  133.               break;
  134.             default:  break;
  135.           }
  136.         }
  137.       }
  138.     }
  139.   }

  141. }


復制代碼

所有資料51hei提供下載:
陀螺儀資料.rar (1.09 MB, 下載次數(shù): 23)




作者: easyming    時間: 2019-9-2 10:12
好資料，正需要�。�！



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