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度
移植过程
我们的目标是在立创开发板GD32E230C8T6上能够控制舵机旋转的功能。首先要获取资料，查看数据手册应如何实现，再移植至我们的工程。
查看资料
在购买时，需要分清楚你的舵机可以转180度，还是360度。360度的舵机是无法控制角度的，只可以控制旋转速度。
SG90的舵机转速不是很快，一般为0.22/60 度或0.18/60 度，所以假如你更改角度控制脉冲的宽度太快时，舵机可能反应不过来。如果需要更快速的反应，就需要更高的转速了。
引脚选择
移植至工程
移植步骤中的导入.c和.h文件与上一节相同，只是将.c和.h文件更改为bsp_sg90.c与bsp_sg90.h。移植完成后面修改相关代码。
详细可见【TTP224触摸传感器】中的移植至工程目录。这里不再过多讲述。移植完成后面修改相关代码。
工程参考入门手册工程模板
在文件bsp_sg90.c中，编写如下代码。
c
/********************************************************************************
* 测试硬件：立创开发板GD32E230C8T6 使用主频200Mhz 晶振25Mhz
* 版 本 号: V1.0
* 修改作者: LC
* 修改日期: 2023年06月26日
* 功能介绍:
******************************************************************************
* 梁山派软硬件资料与相关扩展板软硬件资料官网全部开源
* 开发板官网：www.lckfb.com
* 技术支持常驻论坛，任何技术问题欢迎随时交流学习
* 立创论坛：club.szlcsc.com
* 其余模块移植手册：https://dri8c0qdfb.feishu.cn/docx/EGRVdxunnohkrNxItYTcrwAnnHe
* 关注bilibili账号：【立创开发板】，掌握我们的最新动态！
* 不靠卖板赚钱，以培养中国工程师为己任
*********************************************************************************/
#include "bsp_sg90.h"
#include "systick.h"
unsigned int Servo_Angle = 0;//舵机角度
/******************************************************************
* 函 数 名 称：SG90_Init
* 函 数 说 明：PWM配置
* 函 数 形 参： pre定时器时钟预分频值 per周期
* 函 数 返 回：无
* 作 者：LC
* 备 注：PWM频率=200 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 = 200,000,000/ (20000 * 200) = 50hz
// 周期T = 1/f = 50 = 0.02S = 20ms
timere_initpara.prescaler = 7200-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% = 200-200*7.5%=185
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°）×2ms
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
132
133
134
135
136
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
132
133
134
135
136
在文件bsp_sg90.h中，编写如下代码。
c
/********************************************************************************
* 测试硬件：立创开发板GD32E230C8T6 使用主频200Mhz 晶振25Mhz
* 版 本 号: V1.0
* 修改作者: LC
* 修改日期: 2023年06月26日
* 功能介绍:
******************************************************************************
* 梁山派软硬件资料与相关扩展板软硬件资料官网全部开源
* 开发板官网：www.lckfb.com
* 技术支持常驻论坛，任何技术问题欢迎随时交流学习
* 立创论坛：club.szlcsc.com
* 其余模块移植手册：https://dri8c0qdfb.feishu.cn/docx/EGRVdxunnohkrNxItYTcrwAnnHe
* 关注bilibili账号：【立创开发板】，掌握我们的最新动态！
* 不靠卖板赚钱，以培养中国工程师为己任
*********************************************************************************/
#ifndef _BSP_SG90_H
#define _BSP_SG90_H
#include "gd32e23x.h"
#include "systick.h"
#define RCU_SIG RCU_GPIOA
#define PORT_SIG GPIOA
#define GPIO_SIG GPIO_PIN_2
#define AF_SIG GPIO_AF_0
#define RCU_SIG_TIMER RCU_TIMER14
#define BSP_SIG_TIMER TIMER14 // 定时器
#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
38
39
40
41
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
移植验证
在自己工程中的main主函数中，编写如下。
c
/******************************************************************************
* 测试硬件：立创开发板·GD32E230C8T6 使用主频72Mhz 晶振8Mhz
* 版 本 号: V1.0
* 修改作者: www.lckfb.com
* 修改日期: 2023年11月02日
* 功能介绍:
*****************************************************************************
* 梁山派软硬件资料与相关扩展板软硬件资料官网全部开源
* 开发板官网：www.lckfb.com
* 技术支持常驻论坛，任何技术问题欢迎随时交流学习
* 立创论坛：club.szlcsc.com
* 其余模块移植手册：【立创·GD32E230C8T6开发板】模块移植手册
* 关注bilibili账号：【立创开发板】，掌握我们的最新动态！
* 不靠卖板赚钱，以培养中国工程师为己任
******************************************************************************/
#include "gd32e23x.h"
#include "systick.h"
#include <stdio.h>
#include "bsp_usart.h"
#include "bsp_sg90.h"
int main(void)
{
int i = 0;
systick_config(); // 滴答定时器初始化
usart_gpio_config(9600U); // 串口0初始化
SG90_Init();
while(1)
{
//timer_channel_output_pulse_value_config(BSP_SIG_TIMER,BSP_SIG_CHANNEL,185);
Set_Servo_Angle(i++);
if( i >= 180 )
{
i = 0;
}
delay_1ms(6);
}
}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
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
移植现象：舵机从0度转到180度后，再从0度重新开始转。 （这里找不到那个SG90舵机了，下单购买了还没到，所以先用一个舵机演示一下，代码和原理都是一样的）