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

標題: stm32步進電機平衡車 直立和速度控制代碼 [打印本頁]
作者: bannyff    時間: 2019-5-24 16:03
標題: stm32步進電機平衡車 直立和速度控制代碼
平衡之家的程序修改的。

單片機源程序如下:
  1. #include "sys.h"
  2. u8 Way_Angle=1;      //獲取角度的算法，1：四元數  2：卡爾曼  3：互補濾波 （有的6050使用DMP時，需要開機后不停搖晃小車10S左右，等待數據穩定）
  3. u8 Flag_Qian,Flag_Hou;
  4. float Angle_Balance,Gyro_Balance,Acceleration_Z;
  5. int Moto1,Moto2,Final_Moto1,Final_Moto2;    //電機PWM變量
  6. float Balance_Kp=190,Balance_Kd=0,Velocity_Kp=42,Velocity_Ki=0.21;
  7. //float Zhongzhi=3.89;
  8. int Zhongzhi,Flag_Zhongzhi=0;
  9. int main(void)
  10. {
  11.         Stm32_Clock_Init(9);            //系統時鐘設置
  12.         MY_NVIC_PriorityGroupConfig(2); //=====中斷分組
  13.         delay_init(72);                 //延時初始化
  14.         uart_init(72,9600);           //初始化串口1
  15.         LED_Init();
  16.         IIC_Init();                     //模擬IIC初始化
  17.   MPU6050_initialize();           //=====MPU6050初始化       
  18.         DMP_Init();                     //初始化DMP
  19.         Timer2_Init(50,7200);
  20.         //MiniBalance_EXTI_Init();
  21.         MiniBalance_Motor_Init();       //=====電機方向IO控制初始化
  22.   MiniBalance_PWM_Init();         //=====初始化PWM 輸出
  23.        
  24.         while(1)
  25.                 {
  26.                         //Read_DMP();                      //===讀取傾角
  27.                         //printf("Roll:%f  ",Roll);  //X
  28.                         //printf("Pitch:%f  ",Pitch); //Y
  29.                         //printf("Yaw:%f\r\n",Yaw);   //Z
  30.                         //delay_ms(10);
  31.                        
  32.                 }
  33. }
復制代碼

所有資料51hei提供下載:
步進電機平衡車（DMP）.7z (219.41 KB, 下載次數: 82)






歡迎光臨 (http://m.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板： 手机看片欧美 | 在线色网 | 在线观看91 | 国产精品福利视频 | 成人精品视频 | 国产精品美女久久久久久久久 | 伊人久久av | 国产一级特黄 | 成人午夜 | 久久久婷婷 | 亚洲在线中文字幕 | 久久免费看片 | 成人激情片 | 精品一区二区三 | 亚洲国产精品久久久 | 国内精品国产成人国产三级 | 色一情一乱一乱一区91av | 日韩午夜精品 | 黄色a一级 | 国产一区在线看 | 色婷婷综合网 | 国产精品久久久久久久久久久久午夜片 | 国产伦精品一区二区三毛 | 少妇特黄a一区二区三区 | 午夜精品久久久久 | 婷婷四房综合激情五月 | 天美传媒在线观看 | 中文字幕在线观看网站 | 亚洲成人av在线 | 黄色一级生活片 | 亚洲成人av在线 | 精品久久网站 | 嫩草视频在线观看 | 亚洲一区二区三区免费 | 日韩国产精品视频 | 一级片在线播放 | 日韩成人精品 | 永久黄网站色视频免费观看w | 久草资源在线 | 天堂a在线 | 欧美资源在线 |