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

 找回密碼
 立即注冊

QQ登錄

只需一步,快速開始

搜索
查看: 5233|回復: 1
打印 上一主題 下一主題
收起左側

STM32雙輪自平衡智能競速小車全套設計資料 AHRS運動控制源代碼

[復制鏈接]
跳轉到指定樓層
樓主
STM32 兩輪車 雙輪自平衡車 藍牙遙控 智能競速小車全套資料
這是我 之前做的平衡小車,要做到平衡控制主要還是得理解它的運動狀態。

底盤鈑金3D圖及加工說明:
厚度 3mm
鋁板
表面噴砂氧化本色處理
折彎后要保證和3D模型相同

00 - 原理圖及PCB
01 - 運動控制MCU源代碼(STM32F103RCT6)
02 - 姿態解算MCU源代碼(STM32F103C8T6)
03 - 安卓藍牙遙控器APK及源碼
04 - 整體BOM表格
05 - PCB BOM表格
06 - 上層和中層亞克力3D圖及CAD圖



Altium Designer畫的原理圖和PCB圖如下:(51hei附件中可下載工程文件)


單片機源程序如下:
  1. /* main.c file
  2. 編譯環境:MDK-Lite  Version: 4.23
  3. 測試: 本程序已在第七實驗室的mini IMU上完成測試
  4. 功能:
  5. 1.初始化各個傳感器,
  6. 2.運行姿態解算和高度測量
  7. 3.將解算的姿態和各個傳感器的輸出上傳到 MiniIMU AHRS 測試軟件
  8. 4.響應 PC發送的命令
  9. ------------------------------------*/

  10. /*----------------------------------------------------------------
  11. 修改備忘:
  12. 1/去掉氣壓傳感器數據接口
  13. 2/保持幀格式
  14. 3/數據輸出頻率調整為20hz
  15. 4/調整機頭方向
  16. 5/保留陀螺儀標零偏
  17. 6/去掉UART1數據輸出
  18. 7/只輸出姿態數據結算幀
  19. 8/在數據融合時去掉磁力計的影響
  20. 9/上電數據即可用,不用等待
  21. ----------------------------------------------------------------*/

  22. #include "common.h"  //包含所有的驅動 頭文件

  23. //上傳數據的狀態機
  24. #define REIMU  0x01 //上傳解算的姿態數據
  25. #define REMOV  0x02        //上傳傳感器的輸出
  26. #define REHMC  0x03        //上傳磁力計的標定值

  27. #define Upload_Speed  100   //數據上傳速度  單位 Hz
  28. #define upload_time (1000000/Upload_Speed)  //計算上傳的時間。單位為us

  29. int16_t ax, ay, az;        
  30. int16_t gx, gy, gz;
  31. int16_t hx, hy, hz;
  32. int32_t Temperature = 0, Pressure = 0, Altitude = 0;
  33. uint32_t system_micrsecond;
  34. int16_t hmcvalue[3];
  35. u8 state= REIMU;  //發送特定幀 的狀態機
  36. /**************************實現函數********************************************
  37. *函數原型:                int main(void)
  38. *功  能:                主程序
  39. *******************************************************************************/
  40. int main(void)
  41. {
  42.         int16_t Math_hz=0;
  43.         unsigned char PC_comm; //PC 命令關鍵字節         
  44.         float ypr[3]; // yaw pitch roll
  45.         /* 配置系統時鐘為72M 使用外部8M晶體+PLL*/      
  46.     //SystemInit();
  47.         delay_init(72);                //延時初始化
  48.     Initial_LED_GPIO();        //初始化STM32-SDK板子上的LED接口
  49.         Initial_PWMLED();
  50.         Initial_UART2(115200L);
  51.         load_config();  //從flash中讀取配置信息 -->eeprom.c
  52.         IIC_Init();         //初始化I2C接口
  53.         delay_ms(300);        //等待器件上電
  54.         //UART1_Put_String("Initialize...\r\n");
  55.         IMU_init(); //初始化IMU和傳感器
  56.         system_micrsecond=micros();
  57.         while(1){        //主循環
  58.                
  59.         //delay_ms(1); //延時,不要算那么快。
  60.         IMU_getYawPitchRoll(ypr); //姿態更新
  61.         Math_hz++; //解算次數 ++

  62. //-------------上位機------------------------------
  63.         //是否到了更新 上位機的時間了?
  64.         if((micros()-system_micrsecond)>upload_time){
  65.         switch(state){
  66.         case REIMU:
  67.         UART2_ReportIMU((int16_t)(ypr[0]*10.0),(int16_t)(ypr[1]*10.0),
  68.         (int16_t)(ypr[2]*10.0),Altitude/10,Temperature,Pressure/10,Math_hz*Upload_Speed);
  69.         Math_hz=0;
  70. //        state = REMOV; //更改狀態。
  71.         break;
  72.         case REMOV:
  73.         MPU6050_getlastMotion6(&ax, &ay, &az, &gx, &gy, &gz);
  74.         HMC58X3_getlastValues(&hx,&hy,&hz);
  75.         UART2_ReportMotion(ax,ay,az,gx,gy,gz,hx,hy,hz);
  76.         state = REIMU;
  77.         if(HMC5883_calib)state = REHMC; //需要發送當前磁力計標定值
  78.         break;
  79.         default:
  80.         UART2_ReportHMC(HMC5883_maxx,HMC5883_maxy,HMC5883_maxz,
  81.                  HMC5883_minx,HMC5883_miny,HMC5883_minz,0);//發送標定值
  82.         state = REIMU;
  83.         break;
  84.         }//switch(state)                          
  85.         system_micrsecond=micros();         //取系統時間 單位 us
  86.         LED_Change();        //LED1改變亮度
  87.         }
  88. //--------------------------------------------------
  89.         //處理PC發送來的命令
  90.         if((PC_comm=UART2_CommandRoute())!=0xff)
  91.         {
  92.         switch(PC_comm){ //檢查命令標識
  93.         case Gyro_init:                        MPU6050_InitGyro_Offset(); break; //讀取陀螺儀零偏
  94.         case High_init:                                 break;                //氣壓高度 清零
  95.         case HMC_calib_begin:        HMC5883L_Start_Calib();        break; //開始磁力計標定
  96.         case HMC_calib:                HMC5883L_Save_Calib();        break;   //保存磁力計標定
  97.         }
  98.         }// 處理PC 發送的命令

  99.         }//主循環 while(1) 結束

  100. }  //main        

  101. //------------------End of File----------------------------
復制代碼

所有資料51hei提供下載:
STM32 兩輪車 雙輪自平衡車 藍牙遙控 智能競速小車全套資料.rar (15.28 MB, 下載次數: 90)


評分

參與人數 1黑幣 +50 收起 理由
admin + 50 共享資料的黑幣獎勵!

查看全部評分

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

使用道具 舉報

沙發
ID:693716 發表于 2020-3-5 23:39 來自手機 | 只看該作者
謝謝樓主分享,最近很癡迷這個平衡車相關資料
回復

使用道具 舉報

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

本版積分規則

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

Powered by 單片機教程網

快速回復 返回頂部 返回列表
主站蜘蛛池模板: 国产91色在线 | 亚洲 | 欧美xxxx日本 | 久久看看 | 精品久久久久一区二区国产 | 一本一道久久a久久精品综合蜜臀 | 狠狠干五月天 | 在线一级片 | 激情网五月天 | 色橹橹欧美在线观看视频高清 | 久久久久资源 | 亚洲精品一区二区在线 | 午夜视频一区 | 日韩久久久久久久久久久 | 日韩欧美三区 | 一区二区三区回区在观看免费视频 | 一区二区三区四区五区在线视频 | 亚洲电影免费 | 婷婷色国产偷v国产偷v小说 | 狠狠狠 | 成人精品鲁一区一区二区 | 91人人在线| 国产成人99久久亚洲综合精品 | 在线播放国产一区二区三区 | 在线中文视频 | 欧美vide| 成人久久视频 | 国产精品黄色 | 欧美成年黄网站色视频 | 久久国产成人午夜av影院武则天 | 久久亚洲一区二区三区四区 | 色网站在线免费观看 | 一区二区日本 | 日韩中文字幕一区二区 | 在线观看精品 | 欧美精品中文字幕久久二区 | 成人精品国产免费网站 | 天天操夜夜操免费视频 | 在线中文视频 | 国产欧美精品 | 精品一区二区久久 | 欧美日韩精品在线一区 |