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

標題: STM32自平衡方塊程序，分享資料 [打印本頁]
作者: stc89c52wzy    時間: 2020-4-16 22:42
標題: STM32自平衡方塊程序，分享資料
自平衡方塊，拿去自學
  1. /*       
  2. 知乎：天下行走                                                       
  3. CSDN：技術創造無限可能                               
  4. 閑魚：抉擇之刃銀
  5. */

  7. /*
  8. 針對角度環的期望角度為速度環輸出+機械中值的提問：
  9. 【一】
  10. 問：
  11.         當我在小車（平衡小車）前側綁一塊小鐵塊，這會使得機械中值后傾，=-27度，然后我將車子扶在機械中值的角度位置然后開機，但車子一開機就往前跑。為什么？
  12. 答：
  13.         問題分析：
  14.                                         起始速度偏差=0（因為沒有動輪子呀）——>外環輸出=0（即內環期望角度=0）
  15.                                         But：開局實際角度= -27度——>開局內環輸出就等于(-27-0)*(-1) = +27  //Kp為負數，這里設為-1
  16.                                         即根本是因為開局時 外環輸出！=機械中值(這里機械中值可以等效說成實際角度，但不是任何時候都可以等效說成的。譬如我開機時小車不擺在機械中值位置時就不能等效說成。)
  17.                                         =====>>>>所以開局時車子肯定往前跑！！！                       
  18.         解決思想：
  19.                                         起始Target=Real就可以了。
  20.         解決方法：
  21.                                         測機械中值譬如 = -27度，則使得內環期望角度=外環輸出 + 機械中值。       
  22.                                        
  23. 【二】
  24. 若：外環輸出==機械中值，即開局速度偏差=0時，機械中值=0則外環輸出=0，即內環輸入=0。
  25. 又有內環反饋=0，所以這時候開局內環輸出就等于(0-0)*(-1) = 0===>車子必然直立靜止在原地。

  27. 【三】
  28. 若：外環輸出！=機械中值，即開局速度偏差=0時，機械中值!=0，但我開局不把車子擺在機械中值位置。譬如舉例當機械中值=-27度，我開機將車子實際角度擺在0度位置。則此時
  29. 速度偏差=0則外環輸出=0，即內環輸入=0。
  30. 又有內環反饋=0===>理論上小車直立靜止，BUT！車子根本不在機械中值位置，又談何直立靜止，車子會根據重心向前倒下，直立環立刻發揮作用-->
  31. -->若小鐵快非常非常輕，還有可能救回來；若鐵塊不輕，則必然車子一直不斷向前跑不會停下；若小鐵塊過重，系統來不及響應，車子會直接向前倒下；
  32. 這，就是結果。
  33. */       


  36. /*
  37. 【硬件占用的GPIO的框架】
  38. 編碼器        ||AB相—PA0/PA1
  39. 電機                ||PWM——PA8/PA11、PA6/PA7
  40. MPU6050 ||INT——PB5
  41. MPU6050 ||IIC——SCL--PB4/SDA--PB3
  42. OLED                ||IIC——SCL--PB8/SDA--PB9
  43. */
  44. #include "stm32f10x.h"
  45. #include "sys.h"

  47. float Pitch,Roll,Yaw;                                                                //角度
  48. short gyrox,gyroy,gyroz;                                                //陀螺儀--角速度
  49. short aacx,aacy,aacz;                                                                //加速度
  50. int Encoder_Momentum;                                                                //編碼器數據（速度）

  52. int PWM_MAX=7000,PWM_MIN=-7000;                        //PWM限幅變量
  53. int MOTO1,MOTO2;                                                                                //電機裝載變量
  54.                
  55. extern int Velocity_Momentum_out;                //輸出變量

  57. int main(void)       
  58. {
  59.         delay_init();
  60.         NVIC_Config();
  61.         uart1_init(115200);       
  62.        
  63.         OLED_Init();
  64.         OLED_Clear();
  65.        
  66.         MPU_Init();
  67.         mpu_dmp_init();
  68.         MPU6050_EXTI_Init();
  69.        
  70.         Encoder_TIM2_Init();
  71.         Encoder_TIM4_Init();
  72.         PWM_Init_TIM1(0,7199);        //CH1——PA8、CH4——PA11
  73.         PWM_Init_TIM3(0,7199);        //CH1——PA6、CH2——PA7       
  74.         OLED_Clear();
  75.         OLED_ShowString(5,0,"P",12);
  76.         OLED_ShowChar(5,2,'M',12);
  77.         OLED_ShowString(64,2,"Stop:",12);       
  78.   while(1)
  79.         {
  80.                 OLED_Float(0,15,Pitch,1);                                                                        //角度                                               
  81.                 OLED_Float(0,70,Velocity_Momentum_out,1);        //外環輸出
  82.                 OLED_Float(2,5+15,Encoder_Momentum,1);                //速度讀取
  83.                 OLED_Float(3,5,MOTO1,1 );                                                                        //電機PWM
  84.                
  85.                 OLED_ShowNumber(64+40,2,stop,1,12);                                //停止位
  86.         }        
  87. }
復制代碼


自平衡方塊GFP.7z

258.13 KB, 下載次數: 38, 下載積分: 黑幣 -5





歡迎光臨 (http://www.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板： 中文字幕一区二区三区在线视频 | 激情六月天 | 91精品国产91久久久久久最新 | 国产视频一区二区 | 精品亚洲一区二区三区四区五区 | 国产一区二区在线免费观看 | 久久久精彩视频 | 久久国产美女视频 | 七七婷婷婷婷精品国产 | pacopacomama在线 | 成人在线视频一区 | 中文字幕91| 久久九九色 | 亚洲一区在线日韩在线深爱 | 国产精品一区二区三区在线播放 | 在线视频国产一区 | 黄免费观看视频 | 亚洲一区播放 | 欧美一级黄色片免费观看 | 丝袜久久| 日本一本在线 | 国产日韩av一区二区 | 欧美激情a∨在线视频播放 成人免费共享视频 | 亚洲国产成人精品女人久久久 | 国产精品国产成人国产三级 | 久久久久久久一级 | 亚洲一区 | 视频在线一区二区 | 在线啊v | 成在线人视频免费视频 | 午夜免费福利电影 | 日韩一区二区黄色片 | 一区二区在线看 | 中国大陆高清aⅴ毛片 | 91一区二区 | 国产精品区二区三区日本 | 国产麻豆一区二区三区 | 久久激情视频 | 久久久黑人 | 欧美日韩一 | 成人福利视频 |