標(biāo)題: STM32F4+A3984芯片簡單的步進(jìn)電機(jī)控制程序 [打印本頁]
作者: 煙雨寒    時(shí)間: 2019-3-26 22:05
標(biāo)題: STM32F4+A3984芯片簡單的步進(jìn)電機(jī)控制程序
采用A3984驅(qū)動芯片
同時(shí)也兼容不部分驅(qū)動器
控制主要包括三點(diǎn)：PWM脈沖輸出，DIR方向選擇，EN控制使能
采用定時(shí)器輸出比較模式

單片機(jī)源程序如下:
  1. #include "stm32f4xx.h"
  2. #include "MicroStepDriver.h"
  3. #include "bsp_debug_usart.h"
  4. #include "mpu6050.h"

  6. /**
  7.   * @brief  主函數(shù)
  8.   * @param  無  
  9.   * @retval 無
  10.   */
  11. int main(void)
  12. {
  13. //          signed int step;          //步數(shù)
  14. //    signed int now_place;     //當(dāng)前角度

  16.         //步進(jìn)電機(jī)初始化
  17.         MSD_Init();

  19.     while(1)
  20.   {

  22.         }
  23.                           
  24. }
  25. /*********************************************END OF FILE**********************/
復(fù)制代碼
  1. #include "MicroStepDriver.h"
  2. #include <stdio.h>
  3. #include <math.h>
  4. //系統(tǒng)加減速參數(shù)
  5. //speedRampData srd;
  6. ////記錄步進(jìn)電機(jī)的位置
  7. //int stepPosition = 0;
  8. ////系統(tǒng)電機(jī)、串口狀態(tài)
  9. //struct GLOBAL_FLAGS status = {FALSE, FALSE,TRUE};

  11. /**

  13.   * @brief  定時(shí)器中斷優(yōu)先級配置

  15.   * @param  無

  17.   * @retval 無

  19.   */
  20. static void TIM_NVIC_Config(void)

  22. {
  23.     NVIC_InitTypeDef NVIC_InitStructure;
  24.     // 設(shè)置中斷組為0
  25.     NVIC_PriorityGroupConfig(NVIC_PriorityGroup_0);               
  26.         // 設(shè)置中斷來源
  27.     NVIC_InitStructure.NVIC_IRQChannel = MSD_PULSE_TIM_IRQ;        
  28.         // 設(shè)置搶占優(yōu)先級
  29.     NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 1;         
  30.         // 設(shè)置子優(yōu)先級
  31.     NVIC_InitStructure.NVIC_IRQChannelSubPriority = 1;       
  32.     NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE;
  33.     NVIC_Init(&NVIC_InitStructure);

  35. }
  36. /**

  38.   * @brief  初始化電機(jī)驅(qū)動用到的引腳

  40.   * @param  無

  42.   * @retval 無

  44.   */
  45. static void MSD_GPIO_Config(void)
  46. {
  47.     GPIO_InitTypeDef GPIO_InitStructure;

  49.     //電機(jī)脈沖輸出 GPIO 初始化
  50.     MSD_PULSE_AHBxClock_FUN(MSD_PULSE_GPIO_CLK, ENABLE);
  51.     GPIO_InitStructure.GPIO_Pin =  MSD_PULSE_PIN;
  52.     GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;
  53.     GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
  54.     GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP;
  55.     GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF;
  56.     GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  57.     GPIO_Init(MSD_PULSE_PORT, &GPIO_InitStructure);
  58.       /*  連接 PXx 到 定時(shí)器輸出通道*/
  59.     GPIO_PinAFConfig(MSD_PULSE_PORT,MSD_PULSE_PIN_SOURCE,MSD_PULSE_PIN_AF);
  60.    
  61.     //電機(jī)方向輸出 GPIO 、細(xì)分、reset、sleep初始化
  62.     MSD_DIR_AHBxClock_FUN(MSD_DIR_GPIO_CLK, ENABLE);
  63.     GPIO_InitStructure.GPIO_Pin =  MSD_DIR_PIN;
  64.           GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;
  65.     GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
  66.     GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP;
  67.     GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  68.     GPIO_Init(MSD_DIR_PORT, &GPIO_InitStructure);
  69.     GPIO_ResetBits(MSD_DIR_PORT,MSD_DIR_PIN);
  70.                
  71.         //電機(jī)使能輸出 GPIO 初始化
  72.     MSD_ENA_AHBxClock_FUN(MSD_ENA_GPIO_CLK, ENABLE);
  73.     GPIO_InitStructure.GPIO_Pin =  MSD_ENA_PIN;
  74.     GPIO_InitStructure.GPIO_Mode = GPIO_Mode_OUT;
  75.     GPIO_InitStructure.GPIO_OType = GPIO_OType_PP;
  76.     GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP;
  77.     GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
  78.     GPIO_Init(MSD_ENA_PORT, &GPIO_InitStructure);
  79.     GPIO_ResetBits(MSD_ENA_PORT,MSD_ENA_PIN);
  80. }


  83. ///*
  84. // * 注意：TIM_TimeBaseInitTypeDef結(jié)構(gòu)體里面有5個(gè)成員，TIM6和TIM7的寄存器里面只有
  85. // * TIM_Prescaler和TIM_Period，所以使用TIM6和TIM7的時(shí)候只需初始化這兩個(gè)成員即可，
  86. // * 另外三個(gè)成員是通用定時(shí)器和高級定時(shí)器才有.
  87. // *-----------------------------------------------------------------------------
  88. // *typedef struct
  89. // *{ TIM_Prescaler            都有
  90. // *  TIM_CounterMode                   TIMx,x[6,7]沒有，其他都有
  91. // *  TIM_Period               都有
  92. // *  TIM_ClockDivision        TIMx,x[6,7]沒有，其他都有
  93. // *  TIM_RepetitionCounter    TIMx,x[1,8,15,16,17]才有
  94. // *}TIM_TimeBaseInitTypeDef;
  95. // *-----------------------------------------------------------------------------
  96. // */

  98. /* ----------------   PWM信號 周期和占空比的計(jì)算--------------- */
  99. // ARR ：自動重裝載寄存器的值
  100. // CLK_cnt：計(jì)數(shù)器的時(shí)鐘，等于 Fck_int / (psc+1) = 168M/(psc+1)
  101. // PWM 信號的周期 T = (ARR+1) * (1/CLK_cnt) = (ARR+1)*(PSC+1) / 72M
  102. // 占空比P=CCR/(ARR+1)

  104. static void TIM_Mode_Config(void)
  105. {
  106.   // 開啟定時(shí)器時(shí)鐘,即內(nèi)部時(shí)鐘CK_INT=168M
  107.         MSD_PULSE_TIM_APBxClock_FUN(MSD_PULSE_TIM_CLK,ENABLE);

  109.     /*--------------------時(shí)基結(jié)構(gòu)體初始化-------------------------*/
  110.         TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;
  111.         TIM_TimeBaseStructInit(&TIM_TimeBaseStructure);
  112.     // 自動重裝載寄存器的值，累計(jì)TIM_Period+1個(gè)周期后產(chǎn)生一個(gè)更新或者中斷
  113.         TIM_TimeBaseStructure.TIM_Period=MSD_PULSE_TIM_PERIOD;       
  114.         // 驅(qū)動CNT計(jì)數(shù)器的時(shí)鐘 = Fck_int/(psc+1)
  115.         TIM_TimeBaseStructure.TIM_Prescaler= MSD_PULSE_TIM_PSC;       
  116.         // 時(shí)鐘分頻因子 ，配置死區(qū)時(shí)間時(shí)需要用到
  117.         TIM_TimeBaseStructure.TIM_ClockDivision=TIM_CKD_DIV1;               
  118.         // 計(jì)數(shù)器計(jì)數(shù)模式，設(shè)置為向上計(jì)數(shù)
  119.         TIM_TimeBaseStructure.TIM_CounterMode=TIM_CounterMode_Up;               
  120.         // 重復(fù)計(jì)數(shù)器的值，最大值為255
  121.         //TIM_TimeBaseStructure.TIM_RepetitionCounter=0;       
  122.         // 初始化定時(shí)器
  123.         TIM_TimeBaseInit(MSD_PULSE_TIM, &TIM_TimeBaseStructure);

  125.         /*--------------------輸出比較結(jié)構(gòu)體初始化-------------------*/               
  126.         TIM_OCInitTypeDef  TIM_OCInitStructure;
  127.         // 配置為PWM模式2
  128.         TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM2;
  129.         // 輸出使能
  130.         TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;
  131.         // 互補(bǔ)輸出禁能
  132.         TIM_OCInitStructure.TIM_OutputNState = TIM_OutputNState_Disable;
  133.         // 設(shè)置占空比大小
  134.         TIM_OCInitStructure.TIM_Pulse = MSD_PULSE_TIM_PERIOD/2;
  135.         // 輸出通道電平極性配置
  136.         TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_Low;
  137.         // 輸出通道空閑電平極性配置
  138.         TIM_OCInitStructure.TIM_OCIdleState = TIM_OCIdleState_Reset;
  139.    
  140.         MSD_PULSE_OCx_Init(MSD_PULSE_TIM, &TIM_OCInitStructure);
  141.     //使能TIM1_CH1預(yù)裝載寄存器
  142.         MSD_PULSE_OCx_PreloadConfig(MSD_PULSE_TIM, TIM_OCPreload_Enable);
  143.     //使能TIM1預(yù)裝載寄存器
  144.     TIM_ARRPreloadConfig(MSD_PULSE_TIM, ENABLE);
  145.    
  146.     //設(shè)置中斷源，只有溢出時(shí)才中斷
  147.     TIM_UpdateRequestConfig(MSD_PULSE_TIM,TIM_UpdateSource_Regular);
  148.         // 清除中斷標(biāo)志位
  149.         TIM_ClearITPendingBit(MSD_PULSE_TIM, TIM_IT_Update);
  150.     // 使能中斷
  151.     TIM_ITConfig(MSD_PULSE_TIM, TIM_IT_Update, ENABLE);
  152.         // 使能計(jì)數(shù)器
  153.         TIM_Cmd(MSD_PULSE_TIM, ENABLE);
  154. }
  155. /**

  157.   * @brief  初始化電機(jī)相關(guān)的外設(shè)

  159.   * @param  無

  161.   * @retval 無

  163.   */
  164. void MSD_Init(void)
  165. {
  166.     MSD_GPIO_Config();
  167.    
  168.     TIM_NVIC_Config();

  170.     TIM_Mode_Config();   
  171. }


  174. /*********************************************END OF FILE**********************/
復(fù)制代碼

  1. #include "mpu6050.h"
  2. #include "string.h"

  4. struct STime                stcTime;
  5. struct SAcc                 stcAcc;
  6. struct SGyro                 stcGyro;
  7. struct SAngle         stcAngle;
  8. struct SMag                 stcMag;
  9. struct SDStatus stcDStatus;
  10. struct SPress         stcPress;
  11. struct SLonLat         stcLonLat;
  12. struct SGPSV                 stcGPSV;

  14. //unsigned char [250];

  16. //CopeSerialData為串口中斷調(diào)用函數(shù)，串口每收到一個(gè)數(shù)據(jù)，調(diào)用一次這個(gè)函數(shù)。
  17. //處理串口接收到的陀螺儀數(shù)據(jù)
  18. void CopeSerialData(unsigned char ucData)
  19. {
  20.         static unsigned char ucRxBuffer[250];
  21.         static unsigned char ucRxCnt = 0;       
  22.        
  23.         ucRxBuffer[ucRxCnt++]=ucData;
  24.         if (ucRxBuffer[0]!=0x55) //數(shù)據(jù)頭不對，則重新開始尋找0x55數(shù)據(jù)頭
  25.         {
  26.                 ucRxCnt=0;
  27.                 return;
  28.         }
  29.         if (ucRxCnt<11) {return;}//數(shù)據(jù)不滿11個(gè)，則返回
  30.         else
  31.         {
  32.                 switch(ucRxBuffer[1])
  33.                 {
  34.                         case 0x50:        memcpy(&stcTime,&ucRxBuffer[2],8);break;//memcpy為編譯器自帶的內(nèi)存拷貝函數(shù)，需引用"string.h"，將接收緩沖區(qū)的字符拷貝到數(shù)據(jù)共同體里面，從而實(shí)現(xiàn)數(shù)據(jù)的解析。
  35.                         case 0x51:        memcpy(&stcAcc,&ucRxBuffer[2],8);break;
  36.                         case 0x52:        memcpy(&stcGyro,&ucRxBuffer[2],8);break;
  37.                         case 0x53:        memcpy(&stcAngle,&ucRxBuffer[2],8);break;
  38.                     case 0x54:        memcpy(&stcMag,&ucRxBuffer[2],8);break;
  39.                         case 0x55:        memcpy(&stcDStatus,&ucRxBuffer[2],8);break;
  40.                         case 0x56:        memcpy(&stcPress,&ucRxBuffer[2],8);break;
  41.                         case 0x57:        memcpy(&stcLonLat,&ucRxBuffer[2],8);break;
  42.                         case 0x58:        memcpy(&stcGPSV,&ucRxBuffer[2],8);break;
  43.                 }
  44.                 ucRxCnt=0;
  45.         }
  46. }
復(fù)制代碼


所有資料51hei提供下載:
定時(shí)器.7z (355.16 KB, 下載次數(shù): 37)


作者: 1366267778    時(shí)間: 2020-5-20 20:30
有電路圖嗎
作者: figa    時(shí)間: 2025-5-10 09:59
代碼不行的，



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