STM32单片机步进电机驱动正反转程序

步进电机驱动正反转 其他 都可移植

#include "sys.h"
#include "delay.h"
#include "LED.h"
#include "step.h"
u8 zhengzhuan = 20;
u8 fanzhuan = 5;
int main()
{
    LED_Init();
    delay_init();
    Step_Motor_GPIO_Init();
   

    while(1)
    {
        motorNcircle(20,(bool)1);

        motorNcircle(20,(bool)0);

    }
}
        

1. #include "sys.h"
   
2. #include "delay.h"
   
3. #include "step.h"
   
4. //IN4: PB6  d
   
5. //IN3: PB5  c
   
6. //IN2: PB4  b
   
7. //IN1: PB3   a
   
8. //四相八拍
   
9. u8 phasecw[8] ={0x08,0x0c,0x04,0x06,0x02,0x03,0x01,0x09};// 逆时针100000001100000001000000011000000010000000110000000100001001
   
10. u8 phaseccw[8]={0x09,0x01,0x03,0x02,0x06,0x04,0x0c,0x08};// 顺时针100100000001000000110000001000000110000001000000110000001000
    
11. 
    
12. 
    
13. //引脚初始化
    
14. void Step_Motor_GPIO_Init(void)
    
15. {
    
16.     GPIO_InitTypeDef GPIO_InitStructure;
    
17.     RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE);
    
18.                 RCC_APB2PeriphClockCmd(RCC_APB2Periph_AFIO, ENABLE);//打开AFIO时钟
    
19. 
    
20.     GPIO_PinRemapConfig(GPIO_Remap_SWJ_Disable, ENABLE);   //Full SWJ Disabled (JTAG-DP + SW-DP)  
    
21.    // 改变指定管脚的映射 GPIO_Remap_SWJ_Disable SWJ 完全禁用（JTAG-DP+SW-DP）
    
22. 
    
23.     GPIO_PinRemapConfig(GPIO_Remap_SWJ_JTAGDisable , ENABLE); //JTAG-DP Disabled and SW-DP Enabled
    
24.    // 改变指定管脚的映射 GPIO_Remap_SWJ_JTAGDisable ，JTAG-DP 禁用 + SW-DP 使能
    
25. 
    
26.     GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;
    
27.     GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
    
28.     GPIO_InitStructure.GPIO_Pin = GPIO_Pin_7|GPIO_Pin_6|GPIO_Pin_5|GPIO_Pin_4;
    
29.     GPIO_Init(GPIOB,&GPIO_InitStructure);   
    
30. }
    
31. //引脚映射
    
32. void SetMotor(char InputData)
    
33. {
    
34.     if(InputData&0x01)
    
35.     {
    
36.         GPIO_SetBits(GPIOB,GPIO_Pin_4);
    
37.     }
    
38.     else
    
39.     {
    
40.         GPIO_ResetBits(GPIOB,GPIO_Pin_4);
    
41.     }
    
42.     if(InputData&0x02)
    
43.     {
    
44.         GPIO_SetBits(GPIOB,GPIO_Pin_5);
    
45.     }
    
46.     else
    
47.     {
    
48.         GPIO_ResetBits(GPIOB,GPIO_Pin_5);
    
49. 
    
50.     }
    
51.     if(InputData&0x04)
    
52.     {
    
53.         GPIO_SetBits(GPIOB,GPIO_Pin_6);
    
54.     }
    
55.     else
    
56.     {
    
57.         GPIO_ResetBits(GPIOB,GPIO_Pin_6);
    
58.     }
    
59.     if(InputData&0x08)
    
60.     {
    
61.         GPIO_SetBits(GPIOB,GPIO_Pin_7);
    
62.     }
    
63.     else
    
64.     {
    
65.         GPIO_ResetBits(GPIOB,GPIO_Pin_7);
    
66.     }
    
67. }
    
68. //步距角5.625 360/5.625=64 减速比1/64
    
69. //故64*64个脉冲转一圈
    
70. //n圈数
    
71. //position 方向
    
72. void motorNcircle(int n,bool position)
    
73. {
    
74.     int i,j,k=0;
    
75.     for(j=0;j<n;j++)
    
76.     {
    
77.         //for(i=0;i<64*8;i++)
    
78.         for(i=0;i<8;i++)
    
79.         {
    
80.             for(k=0;k<8;k++)
    
81.             {
    
82.                 if(1 == position)
    
83.                 {
    
84.                     SetMotor(phasecw[k]);
    
85.                 }
    
86.                 else if(0 == position)
    
87.                 {
    
88.                     SetMotor(phaseccw[k]);
    
89.                 }
    
90.                 delay_ms(2);
    
91.             }
    
92.         }
    
93.     }
    
94. }
    

复制代码

原理图: 无
仿真: 无
代码: 2_正反转(success).7z (181.6 KB, 下载次数: 11)

2024-3-15 02:52 上传

点击文件名下载附件