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

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 2440|回復(fù): 1
收起左側(cè)

很全的Leadiy-M3C陀螺儀資料與STM32源程序

[復(fù)制鏈接]
ID:343196 發(fā)表于 2018-6-1 22:41 | 顯示全部樓層 |閱讀模式
希望有更好的可以一起分享上來
0.png

0.png

單片機(jī)源程序如下:
  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. /*讀兩個(gè)字節(jié)組成一個(gè)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(); //讀一個(gè)字節(jié)
  51.       if((BufC==0xA7)){  //判斷是否為幀 頭
  52.         BufC = uartRead(); //讀一個(gè)字節(jié)
  53.         if (BufC==0x7A) { //判斷是否為幀頭
  54.           BufC = uartRead(); //讀一個(gè)字節(jié)
  55.           switch(BufC) //幀類型判斷
  56.           {
  57.             case 0x70: //標(biāo)識為角速度幀
  58.               BufC = uartRead(); //幀長度，可不用
  59.               BufC = uartRead(); //效驗(yàn)位
  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: //標(biāo)識為加速度幀
  74.               BufC = uartRead(); //幀長度，可不用
  75.               BufC = uartRead(); //效驗(yàn)位
  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: //標(biāo)識為姿態(tài)幀
  89.               BufC = uartRead(); //幀長度，可不用
  90.               BufC = uartRead(); //效驗(yàn)位
  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: //標(biāo)識為 地磁幀
  103.               BufC = uartRead(); //幀長度，可不用
  104.               BufC = uartRead(); //效驗(yàn)位
  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: //標(biāo)識為溫度、氣壓幀
  118.               BufC = uartRead(); //幀長度，可不用
  119.               BufC = uartRead(); //效驗(yàn)位
  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: // 標(biāo)識為高度幀
  126.               BufC = uartRead(); //幀長度，可不用
  127.               BufC = uartRead(); //效驗(yàn)位
  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. }


復(fù)制代碼

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




回復(fù)

使用道具 舉報(bào)

ID:102665 發(fā)表于 2019-9-2 10:12 | 顯示全部樓層
好資料，正需要！！！
回復(fù)

使用道具 舉報(bào)

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

本版積分規(guī)則

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

Powered by 單片機(jī)教程網(wǎng)

快速回復(fù) 返回頂部 返回列表
主站蜘蛛池模板： 在线国产一区二区 | 亚洲h在线观看 | 久久国产精品亚洲 | 在线欧美一区 | 欧美日韩在线一区二区三区 | 欧美精品一区在线观看 | 性高湖久久久久久久久aaaaa | 精品一二区 | 精品一区二区免费视频 | 日韩精品1区2区3区 成人黄页在线观看 | 国内精品久久久久久久影视简单 | 麻豆久久久久久久 | h视频在线免费观看 | 婷婷久久综合 | 免费黄色录像片 | av色噜噜 | 操操日| 91社区在线观看高清 | 国产精品96久久久久久 | 在线观看成人小视频 | 在线播放亚洲 | 毛片视频免费 | 亚洲91视频 | 久久久黄色 | 久久久久国产一区二区 | 国产日本精品视频 | 久久久高清 | 一区二区三区四区在线播放 | 欧美一区二区三区久久精品 | 欧美性极品xxxx做受 | 亚洲 91| 欧美亚洲高清 | 免费艹逼视频 | 亚洲国产精久久久久久久 | 欧美一区2区三区3区公司 | 久草免费在线视频 | 天天久 | 久草网址 | 成人av片在线观看 | 亚洲一区二区三区四区五区午夜 | 国产91av视频在线观看 |