STM32CubeIDE基础学习-舵机控制实验

news2025/1/18 17:05:29

STM32CubeIDE基础学习-舵机控制实验

文章目录

STM32CubeIDE基础学习-舵机控制实验
前言
第1章硬件介绍
第2章工程配置
- 2.1 基础工程配置部分
- 2.2 生成工程代码部分
第3章代码编写
第4章实验现象
总结

前言

SG90、MG996舵机在机器人领域用得非常多，因为舵机有内置控制电路，它们的尺寸虽然很小，但输出力够大，但不同型号的舵机对应的力矩也有不同，具体要看具体参数选择。
例如：船舵、航模、机器人等都用得非常多。

STM32CubeIDE基础知识学习回顾

实验目的：
学习使用定时器输出PWM功能，从而实现控制舵机转动指定的角度。

第1章硬件介绍

舵机控制接口采用定时器4通道3，配置时使能该通道即可。

SG90舵机实物如下图所示：

在这里插入图片描述

这款舵机的控制需要一个20ms为周期的脉冲信号，其中高电平的占比在0.5ms ~ 2.5ms之间，当高电平的脉宽在0.5ms ~ 2.5ms之间时舵机就可以对应旋转到0 ~ 180度不同的角度。所以可以通过控制控制信号的高电平宽度来调节输出角度，从而实现方向的控制。

时间和角度对应的控制关系如下：

在这里插入图片描述

当然，上面这些只是常用且比较好计算的时间和角度关系，如果需要旋转其它任意的角度，可以改变对应时间即可。

第2章工程配置

2.1 基础工程配置部分

本实验采用LED实验的工程作为模板，直接在上面添加定时器PWM的功能配置即可。

第一步：配置定时器时钟源。

在这里插入图片描述

按照标号步骤依次选择即可，定时器4使用的是内部时钟源，通道3输出。

第二步：配置定时器和PWM相关参数。

在这里插入图片描述

计数配置：PSC取7199，ARR取199，向上计数模式。

PWM配置：采用PWM1模式，极性为高电平有效，参数Pulse的值可以设置也可以不设置，让其默认为0，这里问题不大，后面在使用时还是会改变该值的。

最终定时器及PWM功能配置完成之后，可以看到芯片的PA8引脚被配置为了TIM4_CH3，如下图所示：

在这里插入图片描述

2.2 生成工程代码部分

配置完功能之后就可以点击生成工程代码了。
可以看到main文件多了一个定时器的初始化函数和tim.c文件，如下图所示：

在这里插入图片描述
进入定时器初始化函数后如下图所示：

在这里插入图片描述

里面主要是设置定时器相关参数等。

在这里插入图片描述

到此，检查生成的初始化代码部分没有问题后就可以编写完成后面的控制功能代码就可以了。

第3章代码编写

在输出PWM之前，需要使能输出通道才可以，即使能CC1E位，使能之后就可以输出PWM了。直接调用函数如下图所示：

在这里插入图片描述
根据舵机的控制原理及公式计算，比较值为5对应舵机是0度，15对应舵机是90度，代码编写如下图所示：

在这里插入图片描述
编译下载代码后，可以看到舵机先归零再转90度，如此往返旋转。

能单独控制指定角度之后，就可以控制常用的角度了，代码如下图所示：

在这里插入图片描述

代码片示例如下：

  /* Infinite loop */
  /* USER CODE BEGIN WHILE */
  while (1)
  {
	  __HAL_TIM_SET_COMPARE(&htim4, TIM_CHANNEL_3, 5);     /* 0度 */
	  HAL_Delay(1000);     /* 旋转间隔时间 */

	  __HAL_TIM_SET_COMPARE(&htim4, TIM_CHANNEL_3, 10);    /* 45度 */
	  HAL_Delay(1000);

	  __HAL_TIM_SET_COMPARE(&htim4, TIM_CHANNEL_3, 15);    /* 90度 */
	  HAL_Delay(1000);

	  __HAL_TIM_SET_COMPARE(&htim4, TIM_CHANNEL_3, 20);    /* 135度 */
	  HAL_Delay(1000);

	  __HAL_TIM_SET_COMPARE(&htim4, TIM_CHANNEL_3, 25);    /* 180度 */
	  HAL_Delay(1000);
	  /* USER CODE END WHILE */
  }