SG90舵机
模块来源
采购链接：
https://detail.tmall.com/item.htm?abbucket=0&id=615779197448&ns=1&spm=a21n57.1.0.0.6f6f523cXTHwFh
资料下载：
https://pan.baidu.com/s/1QsTIKnoQsOTCkeYLLTTjTA?pwd=8889
提取码：8889
规格参数
驱动电压：3V~7.2V
驱动电流：
工作扭矩：1.6KG/CM
控制方式：PWM
转动角度：180度
移植过程
我们的目标是在天空星GD32F407上能够控制舵机旋转的功能。首先要获取资料，查看数据手册应如何实现，再移植至我们的工程。
查看资料
在购买时，需要分清楚你的舵机可以转180度，还是360度。360度的舵机是无法控制角度的，只可以控制旋转速度。
SG90的舵机转速不是很快，一般为0.22/60 度或0.18/60 度，所以假如你更改角度控制脉冲的宽度太快时，舵机可能反应不过来。如果需要更快速的反应，就需要更高的转速了。
引脚选择
移植至工程
移植步骤中的导入.c和.h文件与【2.1 DHT11温湿度传感器】相同，只是将.c和.h文件更改为bsp_sg90.c与bsp_sg90.h。见2.1.3.3 移植至工程。这里不再过多讲述。移植完成后面修改相关代码。
在文件bsp_sg90.c中，编写如下代码。
c
/*
* 立创开发板软硬件资料与相关扩展板软硬件资料官网全部开源
* 开发板官网：www.lckfb.com
* 技术支持常驻论坛，任何技术问题欢迎随时交流学习
* 立创论坛：club.szlcsc.com
* 关注bilibili账号：【立创开发板】，掌握我们的最新动态！
* 不靠卖板赚钱，以培养中国工程师为己任
* Change Logs:
* Date Author Notes
* 2023-11-02 LCKFB-yzh first version
*/
#include "bsp_sg90.h"
unsigned int Servo_Angle = 0;//舵机角度
/******************************************************************
* 函 数 名 称：SG90_Init
* 函 数 说 明：PWM配置
* 函 数 形 参： pre定时器时钟预分频值 per周期
* 函 数 返 回：无
* 作 者：LC
* 备 注：PWM频率=168 000 000 /( (pre+1) * (per+1) )
******************************************************************/
void SG90_Init(void)
{
timer_parameter_struct timere_initpara={0}; // 定义定时器结构体
timer_oc_parameter_struct timer_ocintpara={0}; //定时器比较输出结构体
//定时器时钟
rcu_periph_clock_enable(RCU_SIG_TIMER); // 开启定时器时钟
//引脚时钟
rcu_periph_clock_enable(RCU_SIG);
rcu_timer_clock_prescaler_config(RCU_TIMER_PSC_MUL4); // 配置定时器时钟
/* 配置AIN1*/
gpio_mode_set(PORT_SIG,GPIO_MODE_AF,GPIO_PUPD_NONE,GPIO_SIG);
gpio_output_options_set(PORT_SIG,GPIO_OTYPE_PP,GPIO_OSPEED_50MHZ,GPIO_SIG);
gpio_af_set(PORT_SIG,AF_SIG,GPIO_SIG);
// 复位定时器
timer_deinit(BSP_SIG_TIMER);
/* 配置定时器参数 */
// 频率f =系统时钟 / ( (prescaler+1) * (period+1) )
// 频率f = 168,000,000/ (16800 * 200) = 50hz
// 周期T = 1/f = 1/50 = 0.02S = 20ms
timere_initpara.prescaler = 16800-1; // 时钟预分频值
timere_initpara.alignedmode = TIMER_COUNTER_EDGE; // 边缘对齐
timere_initpara.counterdirection = TIMER_COUNTER_UP; // 向上计数
timere_initpara.period = 200-1; // 周期
timere_initpara.clockdivision = TIMER_CKDIV_DIV1; // 分频因子
timere_initpara.repetitioncounter = 0; // 重复计数器 0-255
timer_init(BSP_SIG_TIMER,&timere_initpara); // 初始化定时器
/* 配置输出结构体 */
timer_ocintpara.ocpolarity = TIMER_OC_POLARITY_HIGH; // 有效电平的极性
timer_ocintpara.outputstate = TIMER_CCX_ENABLE; // 配置比较输出模式状态 也就是使能PWM输出到端口
timer_ocintpara.ocnpolarity = TIMER_OCN_POLARITY_HIGH; // 通道互补输出极性为高电平
timer_ocintpara.outputnstate = TIMER_CCXN_DISABLE; // 通道互补输出状态失能
timer_ocintpara.ocidlestate = TIMER_OC_IDLE_STATE_LOW; // 信道输出的空闲状态为低
timer_ocintpara.ocnidlestate = TIMER_OCN_IDLE_STATE_LOW; // 信道互补输出的空闲状态为低
/* 配置定时器输出功能 */
timer_channel_output_config(BSP_SIG_TIMER,BSP_SIG_CHANNEL,&timer_ocintpara);
/* 配置占空比 范围 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% = 168-168*7.5%=155.6
timer_channel_output_pulse_value_config(BSP_SIG_TIMER,BSP_SIG_CHANNEL,185);
// 配置定时器通道输出比较模式
timer_channel_output_mode_config(BSP_SIG_TIMER,BSP_SIG_CHANNEL,TIMER_OC_MODE_PWM1);
// 配置定时器通道输出影子寄存器
timer_channel_output_shadow_config(BSP_SIG_TIMER,BSP_SIG_CHANNEL,TIMER_OC_SHADOW_DISABLE);
/* 只有高级定时器使用 */
timer_auto_reload_shadow_enable(BSP_SIG_TIMER);
timer_primary_output_config(BSP_SIG_TIMER, ENABLE);
/* 使能定时器 */
timer_enable(BSP_SIG_TIMER);
}
/******************************************************************
* 函 数 名 称：Set_Servo_Angle
* 函 数 说 明：设置角度
* 函 数 形 参：angle=要设置的角度，范围0-180
* 函 数 返 回：无
* 作 者：LC
* 备 注：无
******************************************************************/
void Set_Servo_Angle(unsigned int angle)
{
unsigned int ServoAngle = 0;
//设置的角度超过180度
if( angle > 180 )
{
return ;
}
//保存设置的角度
Servo_Angle = angle;
//换算角度
//高电平时间=0.5ms+（角度/180°）×20ms
ServoAngle = (int)(200*(1-((0.5+angle/90.0)/20.0)));
timer_channel_output_pulse_value_config(BSP_SIG_TIMER,BSP_SIG_CHANNEL,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
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
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
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
在文件bsp_sg90.h中，编写如下代码。
c
/*
* 立创开发板软硬件资料与相关扩展板软硬件资料官网全部开源
* 开发板官网：www.lckfb.com
* 技术支持常驻论坛，任何技术问题欢迎随时交流学习
* 立创论坛：club.szlcsc.com
* 关注bilibili账号：【立创开发板】，掌握我们的最新动态！
* 不靠卖板赚钱，以培养中国工程师为己任
* Change Logs:
* Date Author Notes
* 2023-11-02 LCKFB-yzh first version
*/
#ifndef _BSP_SG90_H
#define _BSP_SG90_H
#include "gd32f4xx.h"
#include "board.h"
#define RCU_SIG RCU_GPIOA
#define PORT_SIG GPIOA
#define GPIO_SIG GPIO_PIN_5
#define AF_SIG GPIO_AF_1
#define RCU_SIG_TIMER RCU_TIMER1
#define BSP_SIG_TIMER TIMER1 // 定时器
#define BSP_SIG_CHANNEL TIMER_CH_0 // 定时器通道
void SG90_Init(void);
void Set_Servo_Angle(unsigned int angle);
unsigned int Get_Servo_Angle(void);
void TIM3_PWM_Init_AllChannel(void);
#endif1
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
* 技术支持常驻论坛，任何技术问题欢迎随时交流学习
* 立创论坛：club.szlcsc.com
* 关注bilibili账号：【立创开发板】，掌握我们的最新动态！
* 不靠卖板赚钱，以培养中国工程师为己任
* Change Logs:
* Date Author Notes
* 2023-11-02 LCKFB-yzh first version
*/
#include "board.h"
#include "bsp_sg90.h"
int main(void)
{
int i = 0;
nvic_priority_group_set(NVIC_PRIGROUP_PRE2_SUB2); // 优先级分组
board_init();
bsp_uart_init();
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
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
移植现象：舵机从0度转到180度后，再从0度重新开始转。
代码下载
链接在资料下载章节的模块移植手册资料那里！！