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

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 2419|回復: 1
收起左側

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

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

0.png

單片機源程序如下:
  1. /*********************************
  2. LEADIY-M3測試程序示例V2.2
  3. 作者: Colin
  4. 版權所有:  深圳市軟芯微電子科技有限公司
  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. /*讀兩個字節組成一個16位數*/
  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.   /* 系統初始化*/
  41.   systemInit();

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

  46.   while (1)
  47.   {
  48.     if(uartAvailable()) //檢測是否收到LEADIY-M3數據
  49.     {  
  50.       BufC = uartRead(); //讀一個字節
  51.       if((BufC==0xA7)){  //判斷是否為幀 頭
  52.         BufC = uartRead(); //讀一個字節
  53.         if (BufC==0x7A) { //判斷是否為幀頭
  54.           BufC = uartRead(); //讀一個字節
  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: //標識為姿態幀
  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; //將航向值轉化到0---360度區間
  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.               /*地磁設置為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, 下載次數: 23)
回復

使用道具 舉報

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

使用道具 舉報

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

本版積分規則

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

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板： 欧美综合在线观看 | 国产黄色精品在线观看 | www.99re5.com| 国产高清一区二区三区 | 日韩成人免费 | 正在播放国产精品 | 国产麻豆乱码精品一区二区三区 | 日一区二区 | 日本成人中文字幕在线观看 | 手机av网| 中文字幕第一页在线 | 国产高清视频 | 99re国产视频| 天堂在线免费视频 | 日韩欧美一区二区三区免费观看 | 亚洲国产69 | 日本成人中文字幕 | 在线视频 中文字幕 | 99精品一级欧美片免费播放 | 狠狠综合久久av一区二区小说 | 伊人网99 | 亚洲九九 | 麻豆一区| 久久久久久久综合 | 波多野结衣一区二区三区在线观看 | 男女激情网站免费 | 天天爽天天干 | 成人免费黄色片 | www.五月婷婷.com | 国产一区二区三区久久 | 一区二区三区国产好 | 欧美一区精品 | 亚洲第一av | 国产探花在线精品一区二区 | 激情三区 | 午夜视频在线观看一区二区 | 日韩成人在线视频 | 亚洲精品乱码久久久久久按摩观 | 激情一区二区三区 | 99精品网站 | 国产精品久久国产精品 |