標(biāo)題: 基于stm32的一個平衡翹翹板小車源碼 [打印本頁]
作者: 循跡小車    時間: 2017-9-27 22:18
標(biāo)題: 基于stm32的一個平衡翹翹板小車源碼
之前找的一個程序，不知道可行不可行

單片機源程序如下:
  1. #include "led.h"
  2. #include "delay.h"
  3. #include "sys.h"
  4. #include "tracking.h"
  5. #include "usart.h"        
  6. #include "pwm.h"
  7. #include "encoder.h"
  8. #include "timer.h"
  9. #include "adc.h"
  10. #include "schedule.h"
  11. #include "DataScope_DP.h"
  12. #include "key.h"

  14. extern struct Encoder Encoder_2;
  15. extern struct Encoder Encoder_4;
  16. extern int Encoder_TIM;
  17. extern int Angel_evalue;
  18. extern int now_ang ;
  19. extern float out_c;
  20. extern int Encoder_first;
  21. extern int Encoder_end;
  22. int main(void)
  23. {
  24.         delay_init();                     //延時函數(shù)初始化         
  25.         LED_Init();                                   //初始化與LED連接的硬件接口
  26.         KEY_Init();
  27.         Inf_Init();                  //初始化與按鍵連接的硬件接口
  28.         LED0=0;                                        //點亮LED
  29.         LED1=0;
  30.         LED2=0;
  31.         Buzzer=0;
  32.         Bluetooth_Init(9600);
  33.         MiniBalance_PWM_Init(7199,0);//不分頻。PWM頻率=72000/(899+1)=80Khz
  34.         EXTIX_Init();
  35.         Encoder_Init_TIM2();
  36.         Encoder_Init_TIM4();
  37.         Angle_Adc_Init();
  38.         PWMLF = 0;
  39.         PWMLB = 0;
  40.         PWMRF = 0;
  41.         PWMRB = 0;
  42. //        delay_ms(100);
  43.         Timer1_Init(49,7199);           //=====定時中斷初始化
  44.         while(1)
  45.         {
  46.                 //printf("%d\n",Encoder_TIM);
  47. //               
  48. //                key=KEY_Scan();
  49. //                if(key==1)
  50. //                        LED0=!LED0;
  51. //                else if(key==2)
  52. //                        LED1=!LED1;
  53. //                else if(key==3)
  54. //                        LED2=!LED2;
  55.         printf(" %d\t",Angel_evalue);
  56.         printf(" %d\n",now_ang);
  57.         printf("%f\n",out_c);
  58.                 printf(" %d\n",Encoder_first);
  59.                 printf(" %d\n",Encoder_end);
  60. //                printf("R: %d\n",Read_Encoder(4));
  61. //                printf("%d\n",Read_Velocity(4));
  62.                 if(Encoder_end>(Encoder_first+100))
  63.                 {
  64.                         Encoder_end-=1;
  65.                         Encoder_first+=1;
  66.                 }
  67.         delay_ms(100);
  68.         }
  69. }
復(fù)制代碼

所有資料51hei提供下載:
2017-7-25-16-50 蹺蹺板.rar (319.35 KB, 下載次數(shù): 8)






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