久久久久久久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://www.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板： 九九热热九九 | 久久久www成人免费精品 | 国产一区二区不卡 | 亚洲午夜精品久久久久久app | 日韩伦理一区二区 | 久久久久一区二区三区 | 国产精品亚洲一区二区三区在线 | 欧美福利在线 | 免费在线日韩 | 国产成人精品高清久久 | 中文字幕 国产精品 | 伊人免费网 | 欧美一区二区三区 | 欧美一级免费看 | 伊人中文字幕 | 日韩日韩日韩日韩日韩日韩日韩 | av一区二区三区四区 | 欧美黑人狂野猛交老妇 | 日韩二区三区 | 一区二区成人 | 国产大片黄色 | 麻豆一区二区三区精品视频 | 亚洲一区影院 | 精品久久一区 | 麻豆国产一区二区三区四区 | 欧美不卡视频一区发布 | 亚洲二区视频 | www.色婷婷| 免费啪啪| 亚洲在线视频 | 亚洲天堂日韩精品 | 精品国产一级 | 天天爽夜夜骑 | 在线不卡视频 | 精品久久久久久久 | 天天玩天天操天天干 | 国产高清精品一区二区三区 | 二区三区视频 | 久久一区精品 | 日韩欧美国产一区二区 | 91小视频在线 |