標題: 基于STM32的PS2遙控手柄，平衡車程序源碼 [打印本頁]
作者: xyl4702140088    時間: 2018-7-8 19:18
標題: 基于STM32的PS2遙控手柄，平衡車程序源碼
基于STM32的PS2遙控手柄，平衡車程序源碼

單片機源程序如下:
  1. /******************** (C) COPYRIGHT (2015)BST BALANCECAR **************************
  2. * 文件名  ：main.c
  3. **********************************************************************************/
  4. //#include "stm32f10x.h"
  5. #include "mpu6050.h"
  6. #include "i2c_mpu6050.h"
  7. #include "motor.h"
  8. #include "upstandingcar.h"
  9. #include "SysTick.h"
  10. #include "led.h"
  11. #include "usart.h"
  12. #include "i2c.h"
  13. //#include "outputdata.h"
  14. #include "timer.h"
  15. #include "UltrasonicWave.h"
  16. //#include "stm32f10x_usart.h"
  17. #include "ps2.h"
  18. #include "delay.h"

  20. float gyz;
  21. int acc;
  22. int acc1;

  24. /*協(xié)議相關*/
  25. //extern u8 newLineReceived = 0;

  27. /*
  28. * 函數(shù)名：main
  29. * 描述  ：主函數(shù)
  30. */
  31. int main(void)
  32. {       
  33.     u8 PS2_KEY = 0, X1=0,Y1=0,X2=0,Y2=0;
  34.         u16 num = 0;  
  35.        
  36.           SystemInit();                   //=====系統(tǒng)初始化
  37.         Timerx_Init(5000,7199);                                   //定時器TIM1
  38. //        UltrasonicWave_Configuration();            //超聲波初始化設置 IO口及中斷設置                            

  40.         //USART1_Config();                                                //串口1初始化 上位機
  41.         USART3_Config();                                                //串口3初始化 藍牙與USART3公用相同IO口
  42.        
  43.         TIM2_PWM_Init();                                           //PWM輸出初始化
  44.         MOTOR_GPIO_Config();                                  //電機IO口初始化
  45.           LED_GPIO_Config();
  46.        
  47. //   TIM3_External_Clock_CountingMode();           //左電機脈沖輸出外部中斷口PA7使用TIM3定時器用作為脈沖數(shù)計算
  48. //   TIM4_External_Clock_CountingMode();           //右電機脈沖輸出外部中斷口PB7使用TIM4定時器用作為脈沖數(shù)計算
  49.           TIM3_Encoder_Init();                       //編碼器獲取脈沖數(shù) PA6 7
  50.           TIM4_Encoder_Init();                       //編碼器獲取脈沖數(shù) PB6 7       
  51.         ////////////////////DMP/////////////////////////////////
  52.         i2cInit();                                                           //IIC初始化 用于掛靠在總線上的設備使用
  53.         delay_nms(10);                                                   //延時10ms
  54.         MPU6050_Init();                                                   //MPU6050 DMP陀螺儀初始化
  55.         PS2_Init();                                                           //PS2手柄初始化
  56.         SysTick_Init();                                                  //SysTick函數(shù)初始化       
  57.         CarUpstandInit();                                          //小車直立參數(shù)初始化
  58.         SysTick->CTRL |=  SysTick_CTRL_ENABLE_Msk;         //使能總算法時鐘
  59.         PrintChar("FFFFFFF \n");
  60.         while (1)
  61.         {

  63. //                 GPIO_ResetBits(GPIOC, GPIO_Pin_13);
  64.                 MPU6050_Pose();                                                 //獲取MPU6050角度狀態(tài)
  65. //                 gy0=gyro[0];
  66. //                 UltrasonicWave_StartMeasure();           //調(diào)用超聲波發(fā)送程序 給Trig腳 <10us 高電平                 
  67. //                 chaoshengbo();                               //計算超聲波測距距離
  68. //      printf("%d",ucBluetoothValue);
  69. //                printf("\t");
  70. //                printf("%f",BST_fSpeedControlOutNew);
  71. //                printf("\t");
  72. //                printf("%f",BST_fCarAngle);
  73. //                printf("\t");
  74. //                 printf("%f",BST_fLeftMotorOut);
  75. //                printf("\t");
  76. //                printf("\n");
  77.                 num++;
  78.                 if(num == 500)
  79.                 {
  80.                         num =0;

  82.                         PS2_KEY = PS2_DataKey();         //手柄按鍵捕獲處理
  83.                         switch(PS2_KEY)
  84.                         {
  85.                                 case PSB_SELECT:         PrintChar("PSB_SELECT \n");  break;
  86.                                 case PSB_L3:             g_newcarstate = enSTOP;  PrintChar("PSB_L3 \n");  break;  
  87.                                 case PSB_R3:             g_newcarstate = enSTOP;         PrintChar("PSB_R3 \n");  break;  
  88.                                 case PSB_START:          PrintChar("PSB_START \n");  break;  
  89.                                 case PSB_PAD_UP:         g_newcarstate = enRUN;   PrintChar("PSB_PAD_UP \n");  break;  
  90.                                 case PSB_PAD_RIGHT:        g_newcarstate = enRIGHT; PrintChar("PSB_PAD_RIGHT \n");  break;
  91.                                 case PSB_PAD_DOWN:        g_newcarstate = enBACK;  PrintChar("PSB_PAD_DOWN \n");  break;
  92.                                 case PSB_PAD_LEFT:        g_newcarstate = enLEFT;  PrintChar("PSB_PAD_LEFT \n");  break;
  93.                                 case PSB_L2:              PrintChar("PSB_L2 \n");  break;
  94.                                 case PSB_R2:              PrintChar("PSB_R2 \n");  break;
  95.                                 case PSB_L1:              PrintChar("PSB_L1 \n");  break;
  96.                                 case PSB_R1:              PrintChar("PSB_R1 \n");  break;     
  97.                                 case PSB_TRIANGLE:        PrintChar("PSB_TRIANGLE \n");  break;
  98.                                 case PSB_CIRCLE:          PrintChar("PSB_CIRCLE \n");  break;
  99.                                 case PSB_CROSS:           PrintChar("PSB_CROSS \n");  break;
  100.                                 case PSB_SQUARE:          PrintChar("PSB_SQUARE \n");  break;
  101.                                 default: g_newcarstate = enSTOP; break;
  102.                         }
  103.                         //獲取模擬值
  104.                         if(PS2_KEY == PSB_L1 || PS2_KEY == PSB_R1)
  105.                         {
  106.                                 X1 = PS2_AnologData(PSS_LX);
  107.                                 Y1 = PS2_AnologData(PSS_LY);
  108.                                 X2 = PS2_AnologData(PSS_RX);
  109.                                 Y2 = PS2_AnologData(PSS_RY);
  110.                                 /*左搖桿*/
  111.                             if (Y1 < 5 && X1 > 80 && X1 < 180) //上
  112.                             {
  113.                               g_newcarstate = enRUN;
  114.                                  
  115.                             }
  116.                             else if (Y1 > 230 && X1 > 80 && X1 < 180) //下
  117.                             {
  118.                               g_newcarstate = enBACK;
  119.                                   
  120.                             }
  121.                             else if (X1 < 5 && Y1 > 80 && Y1 < 180) //左
  122.                             {
  123.                               g_newcarstate = enLEFT;

  125.                             }
  126.                             else if (Y1 > 80 && Y1 < 180 && X1 > 230)//右
  127.                             {
  128.                               g_newcarstate = enRIGHT;

  130.                             }
  131.                             else if (Y1 <= 80 && X1 <= 80) //左上
  132.                             {
  133.                               g_newcarstate = enUPLEFT;
  134.        
  135.                             }
  136.                             else if (Y1 <= 80 && X1 >= 180) //右上
  137.                             {
  138.                               g_newcarstate = enUPRIGHT;
  139.                        
  140.                             }
  141.                             else if (X1 <= 80 && Y1 >= 180) // 左下
  142.                             {
  143.                               g_newcarstate = enDOWNLEFT;
  144.                        
  145.                             }
  146.                             else if (Y1 >= 180 && X1 >= 180) //右下
  147.                             {
  148.                               g_newcarstate = enDOWNRIGHT;
  149.                                   
  150.                             }
  151.                             else//停
  152.                             {
  153.                               g_newcarstate = enSTOP;
  154.                             }

  156.                                  /*右搖桿*/
  157.                             if (X2 < 5 && Y2 > 110 && Y2 < 150) //左
  158.                             {
  159.                               g_newcarstate = enTLEFT;
  160.                             }
  161.                             else if (Y2 > 110 && Y2 < 150 && X2 > 230)//右
  162.                             {
  163.                               g_newcarstate = enTRIGHT;
  164.                             }
  165.                             else//歸位
  166.                             {
  167.                               //
  168.                             }
  169.                         }
  170.                 }
  171.                
  172.        
  173.                 CarStateOut();               
  174.                          
  175.          }
  176.                                                                     
  177. }
復制代碼

所有資料51hei提供下載:
PS2_STM32平衡車程序源碼.rar (695.06 KB, 下載次數(shù): 150)


作者: admin    時間: 2018-7-9 02:13
此貼需要補充說明資料后才可獲得積分
作者: TT1998    時間: 2018-7-29 12:23
樓主會用51連接PS2手柄嗎
作者: mjmajic    時間: 2019-9-19 14:14
這個具體的波形是怎么樣的？
作者: 王二狗.。。。    時間: 2019-9-21 19:36
單片機用的103還是f407
作者: yuhang98    時間: 2020-4-11 16:37
是stm32f103？



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