舵机驱动详解（模拟/数字 STM32）

最新推荐文章于 2025-04-14 11:03:45 发布

辰哥单片机设计

最新推荐文章于 2025-04-14 11:03:45 发布

阅读量3.4k

点赞数 6

分类专栏： STM32执行机构文章标签： stm32 嵌入式硬件单片机传感器

本文链接：https://blog.youkuaiyun.com/qq_44016222/article/details/142724593

版权

STM32执行机构专栏收录该内容

11 篇文章

订阅专栏

一、介绍

舵机(Servo)是在程序的控制下，在一定范围内连续改变输出轴角度并保持的电机系统。即舵机只支持在一定角度内转动，无法像普通直流电机按圈转；其主要控制物体的转动并保持（机器人关节、转向机构）。适用于位置角度经常变化的场合。可以作为理想的电机驱动器件。

以下MG90S舵机模块的参数：

型号	MG90S/MG90
使用电压	4.8V
反应速度	0.11s（4.8V）
转动角度	180度(左90，右90)
使用温度	0~55℃
工作扭矩	2.0kg
产品重量	13.6g

哔哩哔哩视频链接：

舵机驱动详解（模拟/数字 STM32）

（资料分享见文末）

二、模块原理

1.舵机驱动原理

舵机的控制一般需要一个20MS左右的时基脉冲，该脉冲的高电平部分一般为0.5MS-2.5MS范围内的角度控制脉冲部分总间隔为2MS。以180度角度为例，那么对应的控制关系是这样的

2.引脚描述

引脚名称	描述
VCC	供给电压5V
GND	地线
S	信号线

三、程序设计

使用STM32F103C8T6通过按键控制舵机旋转指定角度。

SERVO	PA2
KEY	PB1
OLED_SCL	PB11
OLED_SDA	PB10

main.c文件

#include "stm32f10x.h"
#include "led.h"
#include "usart.h"
#include "delay.h"
#include "oled.h"
#include "servo.h"
#include "key.h"

/*****************辰哥单片机设计******************
											STM32
 * 项目			:	舵机驱动实验                     
 * 版本			: V1.0
 * 日期			: 2024.9.27
 * MCU			:	STM32F103C8T6
 * 接口			:	参看servo.h							
 * BILIBILI	:	辰哥单片机设计
 * 优快云			:	辰哥单片机设计
 * 作者			:	辰哥 

**********************BEGIN***********************/

int key = 0;
float Angle;			//定义角度变量

int main(void)
{ 
	
  SystemInit();//配置系统时钟为72M	
	delay_init(72);
	LED_Init();
	LED_On();
	Servo_Init();
	USART1_Config();//串口初始化
	Key_Init();
	OLED_Init();
	printf("Start \n");
	delay_ms(1000);
	
	OLED_Clear();
	//显示“舵机角度:”
	OLED_ShowChinese(0,0,0,16,1);
	OLED_ShowChinese(16,0,1,16,1);
	OLED_ShowChinese(32,0,2,16,1);
	OLED_ShowChinese(48,0,3,16,1);
	OLED_ShowChar(64,0,':',16,1);

  while (1)
  {
		key = Key_GetData();

		if(key)
		{
			Angle += 30;				//角度变量自增30
			if (Angle > 180)			//角度变量超过180后
			{
				Angle = 0;				//角度变量归零
			}
		}
		Servo_SetAngle(Angle);			//设置舵机的角度为角度变量
		OLED_ShowNum(50, 24, Angle, 3,16,1);	//OLED显示角度变量

  }
}

servo.h文件

#ifndef __SERVO_H
#define	__SERVO_H
#include "stm32f10x.h"
#include "delay.h"
#include "sys.h"

/*****************辰哥单片机设计******************
											STM32
 * 文件			:	舵机驱动驱动h文件                   
 * 版本			: V1.0
 * 日期			: 2024.9.27
 * MCU			:	STM32F103C8T6
 * 接口			:	见代码							
 * BILIBILI	:	辰哥单片机设计
 * 优快云			:	辰哥单片机设计
 * 作者			:	辰哥

**********************BEGIN***********************/


/***************根据自己需求更改****************/
// SERVO舵机 GPIO宏定义

#define	SERVO_CLK										RCC_APB2Periph_GPIOA

#define SERVO_GPIO_PIN 							GPIO_Pin_2
#define SERVO_GPIO_PORT  						GPIOA


/*********************END**********************/

void Servo_Init(void);
void PWM_SetCompare3(uint16_t Compare);
void Servo_SetAngle(float Angle);

#endif

servo.c文件

#include "servo.h"

/*****************辰哥单片机设计******************
											STM32
 * 文件			:	舵机驱动模块c文件                   
 * 版本			: V1.0
 * 日期			: 2024.9.27
 * MCU			:	STM32F103C8T6
 * 接口			:	见代码							
 * BILIBILI	:	辰哥单片机设计
 * 优快云			:	辰哥单片机设计
 * 作者			:	辰哥

**********************BEGIN***********************/


void Servo_Init(void)
{
	RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2,ENABLE);
	RCC_APB2PeriphClockCmd(SERVO_CLK, ENABLE);		//开启GPIOA的时钟
	
	/*GPIO初始化*/
	GPIO_InitTypeDef GPIO_InitStructure;
	GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF_PP;
	GPIO_InitStructure.GPIO_Pin = SERVO_GPIO_PIN;
	GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;
	GPIO_Init(SERVO_GPIO_PORT, &GPIO_InitStructure);						//将PA1和PA2引脚初始化为推挽输出
	
	TIM_InternalClockConfig(TIM2);
	
	//配置时基单元
	TIM_TimeBaseInitTypeDef TIM_TimeBaseInitStructure;
	TIM_TimeBaseInitStructure.TIM_ClockDivision = TIM_CKD_DIV1;		//时钟分频
	TIM_TimeBaseInitStructure.TIM_CounterMode = TIM_CounterMode_Up;		//计数模式
	TIM_TimeBaseInitStructure.TIM_Period = 20000-1;			//自动重装ARR	分辨率
	TIM_TimeBaseInitStructure.TIM_Prescaler = 72 - 1;		//预分频PSC	
	TIM_TimeBaseInitStructure.TIM_RepetitionCounter = 0;
	TIM_TimeBaseInit(TIM2,&TIM_TimeBaseInitStructure);
	
	
	TIM_OCInitTypeDef TIM_OCInitStructure;
	TIM_OCStructInit(&TIM_OCInitStructure);		//给结构体赋予初值 
	
	TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1;
	TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High;
	TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable;
	TIM_OCInitStructure.TIM_Pulse = 0;			//CCR
	TIM_OC3Init(TIM2,&TIM_OCInitStructure);
	
	TIM_Cmd(TIM2,ENABLE);
}	

void PWM_SetCompare3(uint16_t Compare)
{
	TIM_SetCompare3(TIM2, Compare);		//设置CCR2的值
}


void Servo_SetAngle(float Angle)
{
	PWM_SetCompare3(Angle / 180 * 2000 + 500);	//设置占空比
												//将角度线性变换，对应到舵机要求的占空比范围上
}