一、模块来源
二、规格参数
驱动电压:3V~7.2V
工作扭矩:1.6KG/CM
控制方式:PWM
转动角度:180度
以上信息见厂家资料文件
三、移植过程
我们的目标是将例程移植至CW32F030C8T6开发板上【能够控制舵机旋转的功能】。首先要获取资料,查看数据手册应如何实现读取数据,再移植至我们的工程。
1、查看资料
在购买时,需要分清楚你的舵机可以转180度,还是360度。360度的舵机是无法控制角度的,只可以控制旋转速度。
SG90的舵机转速不是很快,一般为0.22/60 度或0.18/60 度,所以假如你更改角度控制脉冲的宽度太快时,舵机可能反应不过来。如果需要更快速的反应,就需要更高的转速了。
2、引脚选择
3、移植至工程
模块工程参考入门手册工程模板
移植步骤中的导入.c和.h文件与第二章的第1小节【DHT11温湿度传感器】相同,只是将.c和.h文件更改为bsp_sg90.c与bsp_sg90.h。这里不再过多讲述,移植完成后面修改相关代码。
在文件bsp_sg90.c中,编写如下代码。
c
/*
* 立创开发板软硬件资料与相关扩展板软硬件资料官网全部开源
* 开发板官网:www.lckfb.com
* 技术支持常驻论坛,任何技术问题欢迎随时交流学习
* 立创论坛:https://oshwhub.com/forum
* 关注bilibili账号:【立创开发板】,掌握我们的最新动态!
* 不靠卖板赚钱,以培养中国工程师为己任
* Change Logs:
* Date Author Notes
* 2024-06-25 LCKFB-LP first version
*/
#include "bsp_sg90.h"
unsigned int Servo_Angle = 0;//舵机角度
/******************************************************************
* 函 数 名 称:SG90_Init
* 函 数 说 明:PWM配置
* 函 数 形 参: pre定时器时钟预分频值 per周期
* 函 数 返 回:无
* 作 者:LC
* 备 注:
配置占空比 范围 0 ~ (per-1)
// t = 0.5ms——————-舵机会转动 0 °
// t = 1.0ms——————-舵机会转动 45°
// t = 1.5ms——————-舵机会转动 90°
// t = 2.0ms——————-舵机会转动 135°
// t = 2.5ms——————-舵机会转动180°
// 1.我该如何计算括号里的数,从而实现我想要的功能?
// 此处以90度为例。
// 答:PWM周期为20ms,所以占空比就应该为1.5ms/20ms = 7.5%,
// 所以 TIMx 捕获比较 1 寄存器值就为period-period*7.5% = 84-84*7.5%=77.7
******************************************************************/
void SG90_Init(void)
{
// 启用 GPIO 和定时器时钟
RCC_SIG_GPIO_ENABLE(); // 启用 GPIO 时钟
RCC_SIG_TIMER_ENABLE(); // 启用定时器时钟
// 初始化 GPIO
GPIO_InitTypeDef GPIO_InitStruct; // GPIO 初始化结构体
GPIO_InitStruct.Pins = GPIO_SIG; // GPIO 引脚
GPIO_InitStruct.Mode = GPIO_MODE_OUTPUT_PP; // 推挽输出模式
GPIO_InitStruct.Speed = GPIO_SPEED_HIGH; // 高速
GPIO_AF_SIG_ENABLE(); // 启用 GPIO 复用功能
GPIO_Init(PORT_SIG, &GPIO_InitStruct); // 初始化 GPIO
// 初始化定时器 (GTIM3)
GTIM_InitTypeDef GTIM_InitStruct; // 定时器初始化结构体
GTIM_InitStruct.Mode = GTIM_MODE_TIME; // 定时器模式
GTIM_InitStruct.OneShotMode = GTIM_COUNT_CONTINUE; // 连续计数模式
GTIM_InitStruct.Prescaler = GTIM_PRESCALER_DIV64; // 预分频器 (DCLK = PCLK / 64 = 64 MHz / 64 = 1 MHz)
GTIM_InitStruct.ReloadValue = 20000 - 1; // 重装载值 (20 ms 周期)
GTIM_InitStruct.ToggleOutState = ENABLE; // 输出翻转功能
GTIM_TimeBaseInit(BSP_SIG_TIMER, >IM_InitStruct); // 初始化定时器
GTIM_OCInit(BSP_SIG_TIMER, BSP_PWM_CHANNEL, GTIM_OC_OUTPUT_PWM_LOW); // 配置输出比较通道为低电平有效的 PWM 模式
GTIM_Cmd(BSP_SIG_TIMER, ENABLE); // 启用定时器
}
/******************************************************************
* 函 数 名 称:Set_Servo_Angle
* 函 数 说 明:设置角度
* 函 数 形 参:angle=要设置的角度,范围0-180
* 函 数 返 回:无
* 作 者:LC
* 备 注:无
******************************************************************/
void Set_Servo_Angle(unsigned int angle)
{
if(angle > 180)
{
angle = 180; // 限制角度在0到180度之间
}
// 计算PWM占空比
// 注意:这里的20000是基于GTIM_Period设置为20000的
// 0.5ms对应的计数 = (0.5 / 20) * 20000
// 2.5ms对应的计数 = (2.5 / 20) * 20000
// 因此,角度从0到180度时,占空比应该从0.5ms到2.5ms线性变化
unsigned int ServoAngle = (unsigned int)((0.5 + (angle / 180.0) * 2.0) / 20.0 * 20000);
GTIM_SetCompare1(BSP_SIG_TIMER, ServoAngle);
}
/******************************************************************
* 函 数 名 称:读取当前角度
* 函 数 说 明:Get_Servo_Angle
* 函 数 形 参:无
* 函 数 返 回:当前角度
* 作 者:LC
* 备 注:使用前必须确保之前使用过
void Set_Servo_Angle(unsigned int angle)
函数设置过角度
******************************************************************/
unsigned int Get_Servo_Angle(void)
{
return Servo_Angle;
}
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
在文件bsp_sg90.h中,编写如下代码。
c
/*
* 立创开发板软硬件资料与相关扩展板软硬件资料官网全部开源
* 开发板官网:www.lckfb.com
* 技术支持常驻论坛,任何技术问题欢迎随时交流学习
* 立创论坛:https://oshwhub.com/forum
* 关注bilibili账号:【立创开发板】,掌握我们的最新动态!
* 不靠卖板赚钱,以培养中国工程师为己任
* Change Logs:
* Date Author Notes
* 2024-06-25 LCKFB-LP first version
*/
#ifndef _BSP_SG90_H
#define _BSP_SG90_H
#include "board.h"
#define RCC_SIG_GPIO_ENABLE() __RCC_GPIOA_CLK_ENABLE()
#define PORT_SIG CW_GPIOA
#define GPIO_SIG GPIO_PIN_6
#define GPIO_AF_SIG_ENABLE() PA06_AFx_GTIM3CH1()
#define RCC_SIG_TIMER_ENABLE() __RCC_GTIM3_CLK_ENABLE()
#define BSP_SIG_TIMER CW_GTIM3 // 定时器
#define BSP_PWM_CHANNEL GTIM_CHANNEL1
void SG90_Init(void);
void Set_Servo_Angle(unsigned int angle);
unsigned int Get_Servo_Angle(void);
void TIM3_PWM_Init_AllChannel(void);
#endif
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
四、移植验证
在自己工程中的main主函数中,编写如下。
C
/*
* 立创开发板软硬件资料与相关扩展板软硬件资料官网全部开源
* 开发板官网:www.lckfb.com
* 技术支持常驻论坛,任何技术问题欢迎随时交流学习
* 立创论坛:https://oshwhub.com/forum
* 关注bilibili账号:【立创开发板】,掌握我们的最新动态!
* 不靠卖板赚钱,以培养中国工程师为己任
* Change Logs:
* Date Author Notes
* 2024-06-25 LCKFB-LP first version
*/
#include "board.h"
#include "stdio.h"
#include "bsp_uart.h"
#include "bsp_sg90.h"
int32_t main(void)
{
int i = 0;
board_init();
uart1_init(115200U);
SG90_Init();
Set_Servo_Angle(180);
delay_ms(1000);
Set_Servo_Angle(0);
delay_ms(1000);
while(1)
{
Set_Servo_Angle(i++);
if( i >= 180 )
{
i = 0;
}
delay_ms(10);
}
}
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
移植现象:舵机从0度转到180度后,再从0度重新开始转。
模块移植成功案例代码:
链接:https://pan.baidu.com/s/1bWrJCuW5w55yN94rDQfZGQ?pwd=LCKF 提取码:LCKF