STM32+A4988控制步进电机

使用硬件型号为:STM32F103C8T6最小系统板、A4988模块、42步进电机(42BYGH39)

1.1 A4988介绍

STM32+A4988控制步进电机_第1张图片
STM32+A4988控制步进电机_第2张图片

引脚 功能说明 接线
EN 使能端,低电平有效 接GND或单片机IOx1
MS1/2/3 步进模式选择 不接或单片机IOx3
SLP 休眠,高电平有效 短接RST
STEP 输入脉冲,一个脉冲转一下 单片机IOx1
DIR 方向位,0/1各代表一方向 单片机IOx1
VMOT/GND 电源接口,直流供电8~35V,最大2A 12/24V电源
1A/1B/2A/2B 步进电机接线 步进电机
VDD/GND 接单片机3.3V和GND 单片机电源

1.2 接线方式

STM32与USB转TTL

STM32 USB转TTL
3.3V/5V 3.3/5V
GND GND
PA9 RXD
PA10 TXD

STM32与A4988

STM32 A4988
3.3V/5V VDD
GND GND
PB6 STEP(motor.h定义)
PB7 DIR (motor.h定义)
EN接GND
SLP接RST

A4988与步进电机

A4988 步进电机
VMOT 12V电源+
GND 12V电源-
B2 B-
A2 B+
A1 A+
B1 A-

需要注意步进电机接线相序

A4988标注的1A、1B、2A、2B,数字代表相、ab代表正负。

步进电机标注的A+、A-、B+、B-,其中AB代表相,±代表正负。

因此接线对应方式应该是:A+和A-对应1A和1B、B+和B-对应2A和2B。比如我的步进电机为黑色A+、绿色A-、红色B+、蓝色B-,那么对应A4988的B2 A2 A1 B1,电机接线顺序就是B- B+ A+ A-(蓝-红-黑-绿)。

如果接错可能会出现电机反转,或只振动不旋转的现象。

1.2 程序设计

本程序为串口控制步进电机,改编自开发板的串口例程,另外编写了步进电机的驱动函数。

GPIO中间的延时表示速度,delay_ms(2)约0.8s每圈,delay_ms(1)约0.4s每圈。

默认情况下(全步进)一个STEP脉冲步进电机转90°。

//motor.h
#ifndef __MOTOR_H
#define __MOTOR_H	 
#include "delay.h"

//PF0-7,12-15

#define Motor_GPIO GPIOF				//PF
#define Motor_RCC RCC_APB2Periph_GPIOF
//第一个步进电机A4988的接线
#define Motor1_STEP	GPIO_Pin_1	//STEP - PF1
#define Motor1_DIR	GPIO_Pin_2	//DIR  - PF2
//第二个步进电机A4988的接线	//PB
#define Motor2_STEP	GPIO_Pin_3	//STEP - PF3
#define Motor2_DIR	GPIO_Pin_4	//DIR  - PF4

void MOTOR_Init(void);
void motor(unsigned int motor1_dir, unsigned int motor1_step, unsigned int motor2_dir, unsigned int motor2_step);



#endif
//motor.c
#include "motor.h"
/*GPIO_motornum和GPIOx用于选择电机,GPIO_direction用于选择电机方向,dir:0为逆1为正,k为90°的倍数*/
// GPIO

void MOTOR_Init()
{
	GPIO_InitTypeDef GPIO_InitStructure;
  RCC_APB2PeriphClockCmd(Motor_RCC,ENABLE);
	
	//Motor初始化
	GPIO_InitStructure.GPIO_Pin = Motor1_STEP|Motor1_DIR|Motor2_STEP|Motor2_DIR;
	GPIO_InitStructure.GPIO_Mode=GPIO_Mode_Out_PP;
	GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
	GPIO_Init(Motor_GPIO,&GPIO_InitStructure);	// 初始化GPIOB
	GPIO_ResetBits(Motor_GPIO,Motor1_STEP);			//初始化GPIOB_6输出低电平
	GPIO_ResetBits(Motor_GPIO,Motor1_DIR);			//初始化GPIOB_7输出低电平
	GPIO_ResetBits(Motor_GPIO,Motor2_STEP);			//初始化GPIOB_8输出低电平
	GPIO_ResetBits(Motor_GPIO,Motor2_DIR);			//初始化GPIOB_9输出低电平
}

void motor(unsigned int motor1_dir, unsigned int motor1_step, unsigned int motor2_dir, unsigned int motor2_step)
{
    unsigned int i;

		switch(motor1_dir)
		{
			case 0 : GPIO_SetBits(Motor_GPIO,Motor1_DIR); break; 
			case 1 : GPIO_ResetBits(Motor_GPIO,Motor1_DIR); break; 
			default : break; 
		}
		switch(motor2_dir)
		{
			case 0 : GPIO_SetBits(Motor_GPIO,Motor2_DIR); break; 
			case 1 : GPIO_ResetBits(Motor_GPIO,Motor2_DIR); break; 
			default : break; 
		}
		/*
		GPIO_SetBits(Motor_GPIO,Motor1_STEP);
		GPIO_SetBits(Motor_GPIO,Motor2_STEP);
		delay_ms(2);									//周期1.3ms
		GPIO_ResetBits(Motor_GPIO,Motor1_STEP);
		GPIO_ResetBits(Motor_GPIO,Motor2_STEP);
		delay_ms(2);
		*/
		for(i = 0;i < motor1_step || i < motor2_step; i++)
		{
			if(i<motor1_step)
			{
				GPIO_SetBits(Motor_GPIO,Motor1_STEP);
				delay_ms(2);									//周期1.3ms
				GPIO_ResetBits(Motor_GPIO,Motor1_STEP);
				delay_ms(2);
			}
			if(i<motor2_step)
			{
				GPIO_SetBits(Motor_GPIO,Motor2_STEP);
				delay_ms(2);									//周期1.3ms
				GPIO_ResetBits(Motor_GPIO,Motor2_STEP);
				delay_ms(2);
			}
		}

    //delay_ms(2);					//延时一会
}

//main.c
#include "delay.h"
#include "sys.h"
#include "usart.h"
#include "mbotLinuxUsart.h"//引用该头文件是使用,通信协议的前提
#include "motor.h"

#define IMAGE_WIDTH		640/2
#define IMAGE_HEIGHT	480/2

//测试发送变量
short testSend1   =1111;
short testSend2   =2222;
short testSend3   =3333;
unsigned char testSend4 = 0x05;

//测试接收变量
int testRece1     =400;
int testRece2     =300;
unsigned char testRece3 = 0x00;


int main(void)
{	
//=======================================变量定义=====================================================
	u8 dir1;
	u8 dir2;
	u16 step1;
	u16 step2;
//======================================硬件初始化====================================================
	delay_init();	    	                        //延时函数初始化	
	NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2); //设置中断优先级分组2
	uart_init(115200);	                            //串口初始化为115200
	MOTOR_Init();				 //初始化A4988驱动

//=======================================循环程序=====================================================
	while(1)
	{
		//将需要发送到ROS的数据,从该函数发出,前三个数据范围(-32768 - +32767),第四个数据的范围(0 - 255)
		usartSendData(testSend1,testSend2,testSend3,testSend4);
		if(testRece1>IMAGE_WIDTH)
		{
			dir1=1;
			step1=testRece1-IMAGE_WIDTH;
		}
		else
		{
			dir1=0;
			step1=IMAGE_WIDTH-testRece1;
		}
		if(testRece2>IMAGE_HEIGHT)
		{
			dir2=0;
			step2=testRece2-IMAGE_HEIGHT;
		}
		else
		{
			dir2=1;
			step2=IMAGE_HEIGHT-testRece2;
		}
		motor(dir1,step1,dir2,step2);
		//必须的延时
		delay_ms(13);
	} 
}

//====================================串口中断服务程序=================================================
void USART1_IRQHandler()
{
	if(USART_GetITStatus(USART1, USART_IT_RXNE) != RESET)
 	 {
		 USART_ClearITPendingBit(USART1,USART_IT_RXNE);//首先清除中断标志位
		 //从ROS接收到的数据,存放到下面三个变量中
		 usartReceiveOneData(&testRece1,&testRece2,&testRece3);
	 }
}
//===========================================END=======================================================

1.3 实验

STM32从ROS系统获取图像中的目标中心坐标。
receiveData1存放目标x值,receiveData2存放目标y值。

由于ROS系统持续发送坐标值,因此STM32实时接受数据进行控制。A4988采用16细分,每次驱动(50循环)步进5.625°,即每个循环0.1°,可考虑根据目标偏移程度设置每次指令步进大小。例如每差1坐标,每次指令加一个循环0.1°。

STM32+A4988控制步进电机_第3张图片

本博客文章首先发布于个人博客:https://www.mahaofei.com/,欢迎大家访问。

你可能感兴趣的:(嵌入式,#,单片机,stm32,单片机)