亚洲春色中文字幕久久久-三上亚,一吻二脱三床四吻胸,国产真实伦对白视频全集,在线毛片观看,精品成品入口黄网,国产毛aⅴ片久久久,亚洲AV色香蕉一区二区三区老师,萧皇后A级艳片,色情日本视频更新,99久久亚洲精品日本无码

標(biāo)題: 兩輪平衡車源程序 直走+藍(lán)牙 [打印本頁]
作者: zsmart    時(shí)間: 2018-6-30 21:13
標(biāo)題: 兩輪平衡車源程序 直走+藍(lán)牙
stm32f103+減速電機(jī)


單片機(jī)源程序如下:
  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度 電機(jī)停止
  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)//右轉(zhuǎn)
  62.      {
  63.        pwmturn=10;
  64.        pwmneed=0;

  66.      }
  67.         if(receive==0x03)//左轉(zhuǎn)
  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   //外部中斷計(jì)脈沖
  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. //定時(shí)器定時(shí)中斷 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);          //計(jì)算X角度a
  118.    
  119.     G_X=read_gyro(gyr_x);                  //計(jì)算X軸轉(zhuǎn)動(dòng)角速度
  120.     erro[2]=erro[1];
  121.     erro[1]=erro[0];
  122.     balan_angle=blance_filter(balan_angle,A_X,G_X); //互補(bǔ)濾波
  123.     erro[0]=balan_angle;
  124.    
  125.     speed=i; //計(jì)算速度
  126.     speed=(int)(0.3*speed+0.7*speed1);  //速度濾波
  127.     speed1=speed;
  128.     position+=speed;   //計(jì)算出位置
  129.     position+=pwmneed; //前進(jìn)后退 積分
  130. ……………………

  132. …………限于本文篇幅 余下代碼請(qǐng)從51黑下載附件…………
復(fù)制代碼

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


作者: JACKLI    時(shí)間: 2019-1-17 22:25
怎么找不到項(xiàng)目文件
代碼是完整的？？？
作者: HXXXX    時(shí)間: 2019-1-22 16:47
這個(gè)是什么平臺(tái)的 MDK5可以編譯嗎



歡迎光臨 (http://www.denmoz.com/bbs/) Powered by Discuz! X3.1