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

 找回密碼
 立即注冊

QQ登錄

只需一步，快速開始

搜索
查看: 2531|回復(fù): 1
打印 上一主題 下一主題
收起左側(cè)

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

[復(fù)制鏈接]
跳轉(zhuǎn)到指定樓層
樓主
希望有更好的可以一起分享上來




單片機(jī)源程序如下:
  1. /*********************************
  2. LEADIY-M3測試程序示例V2.2
  3. 作者: Colin
  4. 版權(quán)所有:  深圳市軟芯微電子科技有限公司
  5. 芯片型號(hào):  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)識(shí)為角速度幀
  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)識(shí)為加速度幀
  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)識(shí)為姿態(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)識(shí)為 地磁幀
  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)識(shí)為溫度、氣壓幀
  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)識(shí)為高度幀
  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)




分享到:  QQ好友和群QQ好友和群 QQ空間QQ空間 騰訊微博騰訊微博 騰訊朋友騰訊朋友
收藏收藏2 分享淘帖 頂頂 踩踩
回復(fù)

使用道具 舉報(bào)

沙發(fā)
ID:102665 發(fā)表于 2019-9-2 10:12 | 只看該作者
好資料，正需要！！！
回復(fù)

使用道具 舉報(bào)

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

本版積分規(guī)則

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

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

快速回復(fù) 返回頂部 返回列表
主站蜘蛛池模板： 国产一区91精品张津瑜 | 欧美 日韩 中文 | 97伦理影院 | 欧美精品 在线观看 | 一区二区三区视频在线观看 | 精品伦精品一区二区三区视频 | 日本精品一区二区三区视频 | 欧美在线日韩 | 激情婷婷成人 | 天堂男人av | 欧美xxxx在线 | 中国人pornoxxx麻豆 | 91在线精品秘密一区二区 | 中文字幕在线第二页 | 视频在线观看一区二区 | 日韩精品一区二区三区在线播放 | 欧美性大战久久久久久久蜜臀 | 成人 在线 | 日本小电影网站 | 美女在线国产 | 成人片免费看 | www国产成人免费观看视频,深夜成人网 | 视频1区 | 91精品久久久久久久久 | 福利在线看 | 日韩欧美中文在线 | 玖玖国产| 国产大片黄色 | 亚洲人在线播放 | 成人精品一区二区三区中文字幕 | 久久国产亚洲精品 | 午夜免费观看网站 | 亚洲人精品午夜 | 成人性生交大片 | 亚洲小视频在线播放 | 精品久久国产 | 蜜桃视频在线观看免费视频网站www | 狠狠热视频 | 国产午夜精品久久久 | 91精品国产91久久久久久密臀 | 玖玖玖在线观看 |