stm32单片机控制伺服电机转动固定角度

stm32单片机控制伺服电机转动固定角度

在用伺服电机进行二维平台移动时,会涉及让二维平台移动一个步长的情况,落实到伺服电机上,就是让伺服电机转动一个固定的角度。所以本文说说让伺服电机转动固定角度,然后停下的方法。

一、简介

这里使用的是“PC机->单片机->伺服电机驱动器->伺服电机”的方式进行伺服电机控制。使用伺服电机的位置控制模式,即只需一路PWM波输入作为位置脉冲,一路高低电平输入作为正反转信号,即可实现伺服电机的转动控制。

伺服电机的位置模式下,伺服电机转动一圈所需要的脉冲数,可以通过改变伺服电机驱动器上电子齿轮比参数的形式进行设置。这里设置伺服电机转动一圈需要5000个脉冲,也就是单片机给5000个脉冲,对应伺服电机转360度。所以电机转动固定角度可以对应到单片机输出固定个数脉冲上。

同时脉冲输出是有周期的,所以要实现伺服电机转动固定角度的目的,可以使用定时器计时的方法,假设脉冲的周期1ms,那么要输出10个脉冲,我只需让定时器定时10ms,当定时器开启的同时开启脉冲输出,当定时结束,关闭脉冲输出即可。

二、硬件准备

PC机+串口调试软件
单片机:stm32f103c8t6
伺服电机驱动器:台达ASD-B2-0421-B
伺服电机:ECMA-C20604RS
USB转TTL转接线
单片机与伺服电机驱动器的连接可以参考
(https://blog.csdn.net/ss123bs456/article/details/117317895)

三、单片机软件

根据上面所说的,单片机的程序中主要涉及:PWM波输出、定时器设置两部分内容。

软件中,我的设定是丝杆导程为10mm,伺服电机转动一圈需要5000个脉冲,电机转速60r/min。要求丝杆上的物块移动1mm的步长后停止,也就是对应500个脉冲。

1、PWM波输出

void TIM3_PWM_Init(u16 arr,u16 psc)
{  
	GPIO_InitTypeDef GPIO_InitStructure;
	TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;
	TIM_OCInitTypeDef  TIM_OCInitStructure;

	RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE);//
 	RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB|RCC_APB2Periph_AFIO, ENABLE);  //使能GPIO外设时钟使能                                                                  	
 
	//设置该引脚为复用输出功能,输出TIM3 CH3的PWM脉冲波形
	GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0; //TIM_CH3
	GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;  //复用推挽输出
	GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
	GPIO_Init(GPIOB, &GPIO_InitStructure);

	TIM_TimeBaseStructure.TIM_Period = arr; //设置在下一个更新事件装入活动的自动重装载寄存器周期的值	 80K
	TIM_TimeBaseStructure.TIM_Prescaler =psc; //设置用来作为TIMx时钟频率除数的预分频值  不分频
	TIM_TimeBaseStructure.TIM_ClockDivision = 0; //设置时钟分割:TDTS = Tck_tim
	TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  //TIM向上计数模式
	TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure); //根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位

	TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM2; //选择定时器模式:TIM脉冲宽度调制模式2
	TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; //比较输出使能
	TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; //输出极性:TIM输出比较极性高
	TIM_OC3Init(TIM3, &TIM_OCInitStructure);  //根据TIM_OCInitStruct中指定的参数初始化外设TIMx

	TIM_OC3PreloadConfig(TIM3, TIM_OCPreload_Enable);  //CH1预装载使能	 
	
	TIM_Cmd(TIM3, ENABLE);  //使能TIM1
}

2、定时器设置
下面是定时器2的初始化程序

void TIM2_Int_Init(u16 arr,u16 psc)
{
  TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;
	NVIC_InitTypeDef NVIC_InitStructure;

	RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE); //时钟使能

	TIM_TimeBaseStructure.TIM_Period = arr; //设置在下一个更新事件装入活动的自动重装载寄存器周期的值	 计数到5000为500ms
	TIM_TimeBaseStructure.TIM_Prescaler =psc; //设置用来作为TIMx时钟频率除数的预分频值  10Khz的计数频率  
	TIM_TimeBaseStructure.TIM_ClockDivision = 0; //设置时钟分割:TDTS = Tck_tim
	TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  //TIM向上计数模式
	TIM_TimeBaseInit(TIM2, &TIM_TimeBaseStructure); //根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位
 
	TIM_ClearITPendingBit(TIM2, TIM_IT_Update);//用于防止开启定时器就立即进入一次中断,从而导致程序出错!!!
	
	TIM_ITConfig(  //使能或者失能指定的TIM中断
		TIM2, //TIM2
		TIM_IT_Update ,
		DISABLE  //使能
		);
	NVIC_InitStructure.NVIC_IRQChannel = TIM2_IRQn;  //TIM2中断
	NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0;  //先占优先级0级
	NVIC_InitStructure.NVIC_IRQChannelSubPriority = 3;  //从优先级3级
	NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //IRQ通道被使能
	NVIC_Init(&NVIC_InitStructure);  //根据NVIC_InitStruct中指定的参数初始化外设NVIC寄存器

	TIM_Cmd(TIM2, ENABLE);  //使能TIMx外设
							 
}

3、串口通信协议
下图程序中,当单片机接收到PC机发来的“act”指令后,单片机中定时器2使能,PWM波输出开启。

void Analysis_Ser(void)
{
	if((USART_RX_BUF[0]=='a')&&(USART_RX_BUF[1]=='c')&&(USART_RX_BUF[2]=='t'))//运行过程中运行一定间隔的距离
	{
		TIM2_Int_Init(999,7199);//每次进入都重装一次定时器的值
		TIM_ITConfig(TIM2,TIM_IT_Update ,ENABLE);//使能定时器2,实现让电机转动一定时间的目标
		LED0=0; //通过开发板上的LED灯的闪烁,让控制效果更明显
		DIRx=1;
		TIM_SetCompare3(TIM3,180);//输出脉冲命令,让电机动
	}
}

4、定时器中断函数
当定时器2计时时间到之后,清除中断待处理位,关闭PWM波输出,关闭定时器2。

void TIM2_IRQHandler(void)   //TIM2中断
{
	if (TIM_GetITStatus(TIM2, TIM_IT_Update) != RESET) //检查指定的TIM中断发生与否:TIM 中断源 
	{
		TIM_ClearITPendingBit(TIM2, TIM_IT_Update); //清除TIMx的中断待处理位:TIM 中断源 	
		
		TIM_SetCompare3(TIM3,0);//时间到后,停止脉冲输出
		LED0=1;
		TIM_ITConfig(TIM2,TIM_IT_Update ,DISABLE); //关闭定时器2
	}
}

5、main函数

int main(void)
{	
	u8 len,t;
	delay_init();	    	 //延时函数初始化	  
	DIR_Init();					//方向引脚初始化
	NVIC_Configuration();//中断分组
	TIM2_Int_Init(999,7199);//定时100ms
	uart_init(9600);//串口初始化
    TIM3_PWM_Init(359,39);
	TIM_SetCompare3(TIM3,0);
	while(1)
	{
 		if(USART_RX_STA&0x8000)
		{
			len=USART_RX_STA&0x3fff;//得到此次接收到的数据长度
			printf("\r\n您发送的消息为:\r\n");
			for(t=0;t<len;t++)
			{
				USART1->DR=USART_RX_BUF[t];
				while((USART1->SR&0X40)==0);//等待发送结束
			}
			printf("\r\n\r\n");//插入换行
			Analysis_Ser();//数据解析函数
			USART_RX_STA=0;//标志位清零
		}
	} 
}

四、总结

根据上面的程序进行工程搭建就可以实现想要的功能。可以用正点原子给的串口通信和PWM输出的例程进行该工程的搭建。

使用PC上的串口通信软件,向单片机发送“act”指令会发现,每发送一个“act”指令,伺服电机都会先转动固定的角度,然后停止。

写的不妥之处请大家见谅,欢迎大家留言批评指正!

版权声明:本文为CSDN博主「你是个好人噢」的原创文章,遵循CC 4.0 BY-SA版权协议,转载请附上原文出处链接及本声明。
原文链接:https://blog.csdn.net/ss123bs456/article/details/117362701

stm32单片机控制伺服电机转动固定角度

在用伺服电机进行二维平台移动时,会涉及让二维平台移动一个步长的情况,落实到伺服电机上,就是让伺服电机转动一个固定的角度。所以本文说说让伺服电机转动固定角度,然后停下的方法。

一、简介

这里使用的是“PC机->单片机->伺服电机驱动器->伺服电机”的方式进行伺服电机控制。使用伺服电机的位置控制模式,即只需一路PWM波输入作为位置脉冲,一路高低电平输入作为正反转信号,即可实现伺服电机的转动控制。

伺服电机的位置模式下,伺服电机转动一圈所需要的脉冲数,可以通过改变伺服电机驱动器上电子齿轮比参数的形式进行设置。这里设置伺服电机转动一圈需要5000个脉冲,也就是单片机给5000个脉冲,对应伺服电机转360度。所以电机转动固定角度可以对应到单片机输出固定个数脉冲上。

同时脉冲输出是有周期的,所以要实现伺服电机转动固定角度的目的,可以使用定时器计时的方法,假设脉冲的周期1ms,那么要输出10个脉冲,我只需让定时器定时10ms,当定时器开启的同时开启脉冲输出,当定时结束,关闭脉冲输出即可。

二、硬件准备

PC机+串口调试软件
单片机:stm32f103c8t6
伺服电机驱动器:台达ASD-B2-0421-B
伺服电机:ECMA-C20604RS
USB转TTL转接线
单片机与伺服电机驱动器的连接可以参考
(https://blog.csdn.net/ss123bs456/article/details/117317895)

三、单片机软件

根据上面所说的,单片机的程序中主要涉及:PWM波输出、定时器设置两部分内容。

软件中,我的设定是丝杆导程为10mm,伺服电机转动一圈需要5000个脉冲,电机转速60r/min。要求丝杆上的物块移动1mm的步长后停止,也就是对应500个脉冲。

1、PWM波输出

void TIM3_PWM_Init(u16 arr,u16 psc)
{  
	GPIO_InitTypeDef GPIO_InitStructure;
	TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;
	TIM_OCInitTypeDef  TIM_OCInitStructure;

	RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM3, ENABLE);//
 	RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB|RCC_APB2Periph_AFIO, ENABLE);  //使能GPIO外设时钟使能                                                                  	
 
	//设置该引脚为复用输出功能,输出TIM3 CH3的PWM脉冲波形
	GPIO_InitStructure.GPIO_Pin = GPIO_Pin_0; //TIM_CH3
	GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;  //复用推挽输出
	GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
	GPIO_Init(GPIOB, &GPIO_InitStructure);

	TIM_TimeBaseStructure.TIM_Period = arr; //设置在下一个更新事件装入活动的自动重装载寄存器周期的值	 80K
	TIM_TimeBaseStructure.TIM_Prescaler =psc; //设置用来作为TIMx时钟频率除数的预分频值  不分频
	TIM_TimeBaseStructure.TIM_ClockDivision = 0; //设置时钟分割:TDTS = Tck_tim
	TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  //TIM向上计数模式
	TIM_TimeBaseInit(TIM3, &TIM_TimeBaseStructure); //根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位

	TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM2; //选择定时器模式:TIM脉冲宽度调制模式2
	TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; //比较输出使能
	TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; //输出极性:TIM输出比较极性高
	TIM_OC3Init(TIM3, &TIM_OCInitStructure);  //根据TIM_OCInitStruct中指定的参数初始化外设TIMx

	TIM_OC3PreloadConfig(TIM3, TIM_OCPreload_Enable);  //CH1预装载使能	 
	
	TIM_Cmd(TIM3, ENABLE);  //使能TIM1
}

2、定时器设置
下面是定时器2的初始化程序

void TIM2_Int_Init(u16 arr,u16 psc)
{
  TIM_TimeBaseInitTypeDef  TIM_TimeBaseStructure;
	NVIC_InitTypeDef NVIC_InitStructure;

	RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE); //时钟使能

	TIM_TimeBaseStructure.TIM_Period = arr; //设置在下一个更新事件装入活动的自动重装载寄存器周期的值	 计数到5000为500ms
	TIM_TimeBaseStructure.TIM_Prescaler =psc; //设置用来作为TIMx时钟频率除数的预分频值  10Khz的计数频率  
	TIM_TimeBaseStructure.TIM_ClockDivision = 0; //设置时钟分割:TDTS = Tck_tim
	TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up;  //TIM向上计数模式
	TIM_TimeBaseInit(TIM2, &TIM_TimeBaseStructure); //根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位
 
	TIM_ClearITPendingBit(TIM2, TIM_IT_Update);//用于防止开启定时器就立即进入一次中断,从而导致程序出错!!!
	
	TIM_ITConfig(  //使能或者失能指定的TIM中断
		TIM2, //TIM2
		TIM_IT_Update ,
		DISABLE  //使能
		);
	NVIC_InitStructure.NVIC_IRQChannel = TIM2_IRQn;  //TIM2中断
	NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0;  //先占优先级0级
	NVIC_InitStructure.NVIC_IRQChannelSubPriority = 3;  //从优先级3级
	NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //IRQ通道被使能
	NVIC_Init(&NVIC_InitStructure);  //根据NVIC_InitStruct中指定的参数初始化外设NVIC寄存器

	TIM_Cmd(TIM2, ENABLE);  //使能TIMx外设
							 
}

3、串口通信协议
下图程序中,当单片机接收到PC机发来的“act”指令后,单片机中定时器2使能,PWM波输出开启。

void Analysis_Ser(void)
{
	if((USART_RX_BUF[0]=='a')&&(USART_RX_BUF[1]=='c')&&(USART_RX_BUF[2]=='t'))//运行过程中运行一定间隔的距离
	{
		TIM2_Int_Init(999,7199);//每次进入都重装一次定时器的值
		TIM_ITConfig(TIM2,TIM_IT_Update ,ENABLE);//使能定时器2,实现让电机转动一定时间的目标
		LED0=0; //通过开发板上的LED灯的闪烁,让控制效果更明显
		DIRx=1;
		TIM_SetCompare3(TIM3,180);//输出脉冲命令,让电机动
	}
}

4、定时器中断函数
当定时器2计时时间到之后,清除中断待处理位,关闭PWM波输出,关闭定时器2。

void TIM2_IRQHandler(void)   //TIM2中断
{
	if (TIM_GetITStatus(TIM2, TIM_IT_Update) != RESET) //检查指定的TIM中断发生与否:TIM 中断源 
	{
		TIM_ClearITPendingBit(TIM2, TIM_IT_Update); //清除TIMx的中断待处理位:TIM 中断源 	
		
		TIM_SetCompare3(TIM3,0);//时间到后,停止脉冲输出
		LED0=1;
		TIM_ITConfig(TIM2,TIM_IT_Update ,DISABLE); //关闭定时器2
	}
}

5、main函数

int main(void)
{	
	u8 len,t;
	delay_init();	    	 //延时函数初始化	  
	DIR_Init();					//方向引脚初始化
	NVIC_Configuration();//中断分组
	TIM2_Int_Init(999,7199);//定时100ms
	uart_init(9600);//串口初始化
    TIM3_PWM_Init(359,39);
	TIM_SetCompare3(TIM3,0);
	while(1)
	{
 		if(USART_RX_STA&0x8000)
		{
			len=USART_RX_STA&0x3fff;//得到此次接收到的数据长度
			printf("\r\n您发送的消息为:\r\n");
			for(t=0;t<len;t++)
			{
				USART1->DR=USART_RX_BUF[t];
				while((USART1->SR&0X40)==0);//等待发送结束
			}
			printf("\r\n\r\n");//插入换行
			Analysis_Ser();//数据解析函数
			USART_RX_STA=0;//标志位清零
		}
	} 
}

四、总结

根据上面的程序进行工程搭建就可以实现想要的功能。可以用正点原子给的串口通信和PWM输出的例程进行该工程的搭建。

使用PC上的串口通信软件,向单片机发送“act”指令会发现,每发送一个“act”指令,伺服电机都会先转动固定的角度,然后停止。

写的不妥之处请大家见谅,欢迎大家留言批评指正!

版权声明:本文为CSDN博主「你是个好人噢」的原创文章,遵循CC 4.0 BY-SA版权协议,转载请附上原文出处链接及本声明。
原文链接:https://blog.csdn.net/ss123bs456/article/details/117362701

生成海报
点赞 0

你是个好人噢

我还没有学会写个人说明!

暂无评论

发表评论

相关推荐

stm32f103c8t6单片机驱动台达伺服电机

stm32f103c8t6单片机驱动台达伺服电机 在做毕业设计时,需要使用伺服电机,但在此之前完全是个伺服小白,在开发的过程中遇到了很多问题,现在毕设结束了,我想把开发的过

stm32单片机控制伺服电机转动固定角度

stm32单片机控制伺服电机转动固定角度 在用伺服电机进行二维平台移动时,会涉及让二维平台移动一个步长的情况,落实到伺服电机上,就是让伺服电机转动一个固定的角度。所以本文说说让伺服电机转动固定角度&#

基于STM32的指纹密码锁

设计简介: 本设计是基于单片机的指纹密码锁,主要实现以下功能: 矩阵按键输入密码,并通过按键显示*号可通过按键或手机开门密码可通过按键进行开门可通过蓝牙模块连接手机进行开门可通过指纹进

STM32串口发送接收数据

1.串口通信 我用的32是stm32f10x最小系统没有UART4和UART5 USART : 通用同步异步收发器 UART : 通用异步收发器 nRTS : 请求发送 nCTS : 请求接收 区别:USART指单片机的一个IO端