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

標題: 兩輪平衡車源程序 直走+藍牙 [打印本頁]
作者: zsmart    時間: 2018-6-30 21:13
標題: 兩輪平衡車源程序 直走+藍牙
stm32f103+減速電機


單片機源程序如下:
  1. /***************************************************************
  2. 自平衡程序
  3. ***************************************************************/
  4. #include "main.h"
  5. #define position_max 6000  //位置最大值
  6. int j=0;
  7. int position=0;
  8. int k=0;
  9. int i=0;
  10. int speed1=0;
  11. int speed=0;
  12. int acc_y=0;
  13. int acc_z=0;
  14. int gyr_x=0;
  15. int receive=0;
  16. int pwm=0;
  17. float G_X=0,A_X=0;
  18. float gyro_angle=0;
  19. float balan_angle=0;
  20. float balan_angle1=0;
  21. float G_X1=0,A_X1=0,G_X2=0,G_X3=0,GXERRO=0;
  22. float erro[3];
  23. int pwmneed=0;
  24. int pwmturn=0;
  25. void adjust(void);

  27. void judge()
  28. {
  29.   pwm=PID_control(erro[0],G_X)+PID_control_2(speed,position);
  30.   //pwm+=pwmneed;
  31.   if(pwm>100) //pwm限幅
  32.   {
  33.     pwm=100;
  34.   }
  35.   if(pwm<-100)
  36.   {
  37.     pwm=-100;
  38.   }
  39.   moto_right(pwm+pwmturn);   
  40.   moto_left(pwm-pwmturn);
  41.   if((balan_angle>45)||(balan_angle<(-45)))//角度大于45度 電機停止
  42.   {
  43.      moto_stop();
  44.   }
  45. }

  47. void bluetooth()
  48. {
  49.      while (!(IFG1 & URXIFG0));   
  50.      receive=U0RXBUF;
  51.      if(receive==0x01)  //直走
  52.      {
  53.        pwmneed=12;
  54.        pwmturn=0;
  55.      }
  56.       if(receive==0x02)//后退
  57.      {  
  58.        pwmneed=-13;
  59.        pwmturn=0;
  60.      }
  61.      if(receive==0x04)//右轉
  62.      {
  63.        pwmturn=10;
  64.        pwmneed=0;

  66.      }
  67.         if(receive==0x03)//左轉
  68.      {
  69.         pwmturn=-10;
  70.         pwmneed=0;
  71.      }
  72.           if(receive==0x00)//停
  73.      {
  74.         pwmturn=0;
  75.         pwmneed=0;
  76.      }
  77. }

  79. void main(void)
  80. {
  81.    WDTCTL=WDTPW+WDTHOLD;
  82.    init_all( );
  83.    InitMPU6050();        //初始化MPU6050
  84.    _EINT();           //開總中斷
  85.    while(1)
  86.    {
  87.     bluetooth();
  88.   }
  89. }

  91. #pragma vector=PORT1_VECTOR   //外部中斷計脈沖
  92. __interrupt void port1(void)
  93. {
  94.   
  95.   if(P1IFG&BIT0==BIT0)
  96.   {  
  97.     P1IFG=0X00;
  98.     if((P1IN&BIT1)==BIT1)
  99.     i++;
  100.     else
  101.     i--;
  102.   }
  103. }

  105. //定時器定時中斷 10ms
  106. #pragma vector=TIMERA0_VECTOR
  107. __interrupt void Timer_A(void)
  108. {
  109.    adjust();
  110. }

  112. void adjust(void)
  113. {
  114.     acc_y=GetData(ACCEL_YOUT_H);               //讀取三軸Y的 值
  115.     acc_z=GetData(ACCEL_ZOUT_H);               //讀取三軸Z的 值
  116.     gyr_x=GetData(GYRO_XOUT_H);                //讀取陀螺儀X的值
  117.     A_X=count_acc_angle(acc_y,acc_z);          //計算X角度a
  118.    
  119.     G_X=read_gyro(gyr_x);                  //計算X軸轉動角速度
  120.     erro[2]=erro[1];
  121.     erro[1]=erro[0];
  122.     balan_angle=blance_filter(balan_angle,A_X,G_X); //互補濾波
  123.     erro[0]=balan_angle;
  124.    
  125.     speed=i; //計算速度
  126.     speed=(int)(0.3*speed+0.7*speed1);  //速度濾波
  127.     speed1=speed;
  128.     position+=speed;   //計算出位置
  129.     position+=pwmneed; //前進后退 積分
  130. ……………………

  132. …………限于本文篇幅 余下代碼請從51黑下載附件…………
復制代碼

所有資料51hei提供下載:
自平衡小車 - 直走 藍牙.zip (61.94 KB, 下載次數: 70)


作者: JACKLI    時間: 2019-1-17 22:25
怎么找不到項目文件
代碼是完整的？？？
作者: HXXXX    時間: 2019-1-22 16:47
這個是什么平臺的 MDK5可以編譯嗎



歡迎光臨 (http://m.zg4o1577.cn/bbs/) Powered by Discuz! X3.1
主站蜘蛛池模板： 在线中文视频 | 亚洲成人精选 | 国产亚洲欧美在线视频 | 免费视频一区二区三区在线观看 | 激情五月婷婷综合 | 成人影院一区二区三区 | 国产精品久久久久久久久久久久久 | 91福利在线观看视频 | 久久com | 国产一区二区三区四区 | 欧美5区| 亚洲成人一区二区 | 亚洲国产一区二区在线 | 午夜成人免费视频 | 中文字幕精品视频 | 99久久99| 在线观看三级av | 国产精品久久777777 | 特级毛片爽www免费版 | 国产一区二区精品 | 欧美精品日韩精品国产精品 | 亚洲欧美日韩精品久久亚洲区 | 国产亚洲精品久久yy50 | 成人一区二区三区在线观看 | 久久这里有精品 | 亚洲第一网站 | 国产精品一区二区久久 | 久久午夜精品福利一区二区 | 波多野吉衣久久 | 一本一道久久a久久精品综合 | 久久69精品久久久久久久电影好 | 天天拍天天草 | 日韩免费一区 | 涩涩视频网 | 欧美a在线 | 国产情侣久久 | 中文字幕av亚洲精品一部二部 | 成人免费视频观看视频 | 亚洲视频在线观看 | 日本超碰 | 国产精品成人av |