一、模块来源
二、规格参数
驱动电压:3V~7.2V
工作扭矩:1.6KG/CM
控制方式:PWM
转动角度:180度
以上信息见厂家资料文件
三、移植过程
我们的目标是将例程移植至开发板上【能够控制舵机旋转的功能】。首先要获取资料,查看数据手册应如何实现读取数据,再移植至我们的工程。
1、查看资料
在购买时,需要分清楚你的舵机可以转180度,还是360度。360度的舵机是无法控制角度的,只可以控制旋转速度。
SG90的舵机转速不是很快,一般为0.22/60 度或0.18/60 度,所以假如你更改角度控制脉冲的宽度太快时,舵机可能反应不过来。如果需要更快速的反应,就需要更高的转速了。
2、引脚选择
3、移植至工程
移植步骤中的导入.c和.h文件与传感器章节的【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-03-22 LCKFB-LP first version
*/
#include "bsp_sg90.h"
unsigned int Servo_Angle = 0;//舵机角度
/******************************************************************
* 函 数 名 称:SG90_Init
* 函 数 说 明:PWM配置
* 函 数 形 参: pre定时器时钟预分频值 per周期
* 函 数 返 回:无
* 作 者:LC
* 备 注:PWM频率=84 000 000 /( (pre+1) * (per+1) )
配置占空比 范围 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)
{
/* 配置定时器参数 */
// 频率f =系统时钟 / ( (prescaler+1) * (period+1) )
// 频率f = 84,000,000/ (8400 * 200) = 50hz
// 周期T = 1/f = 1/50 = 0.02S = 20ms
GPIO_InitTypeDef GPIO_InitStructure;
TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
TIM_OCInitTypeDef TIM_OCInitStructure;
RCC_APB1PeriphClockCmd(RCC_SIG_TIMER, ENABLE); //使能定时器3时钟
RCC_AHB1PeriphClockCmd(RCC_SIG, ENABLE); //使能GPIO外设
//设置该引脚为复用输出功能,输出TIM3
GPIO_InitStructure.GPIO_Pin = GPIO_SIG;
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF; //复用推挽输出
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_100MHz;
GPIO_Init(PORT_SIG, &GPIO_InitStructure);//初始化GPIO
GPIO_PinAFConfig(PORT_SIG, GPIO_SIG_SOURCE, AF_SIG); //复用
//初始化TIM3
//配置占空比 范围 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
TIM_TimeBaseStructure.TIM_Period = 200-1; //设置在下一个更新事件装入活动的自动重装载寄存器周期的值
TIM_TimeBaseStructure.TIM_Prescaler =8400-1; //设置用来作为TIMx时钟频率除数的预分频值
TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1; // 时钟分频
TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; //TIM向上计数模式
TIM_TimeBaseInit(BSP_SIG_TIMER, &TIM_TimeBaseStructure); //根据TIM_TimeBaseInitStruct中指定的参数初始化TIMx的时间基数单位
//初始化TIM3 Channel1 PWM模式
TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1; //选择定时器模式:TIM脉冲宽度调制模式2
TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; //比较输出使能
TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_High; //输出极性
TIM_OC1Init(BSP_SIG_TIMER, &TIM_OCInitStructure); //根据T指定的参数初始化外设TIM3 OC1
TIM_OC1PreloadConfig(BSP_SIG_TIMER, TIM_OCPreload_Enable); //使能TIM3在CCR1上的预装载寄存器
TIM_Cmd(BSP_SIG_TIMER, ENABLE); //使能TIM3
}
/******************************************************************
* 函 数 名 称:Set_Servo_Angle
* 函 数 说 明:设置角度
* 函 数 形 参:angle=要设置的角度,范围0-180
* 函 数 返 回:无
* 作 者:LC
* 备 注:无
******************************************************************/
void Set_Servo_Angle(unsigned int angle)
{
if(angle > 180)
{
angle = 180; // 限制角度在0到180度之间
}
// 计算PWM占空比
// 注意:这里的200是基于TIM_Period设置为199的(200-1)
// 0.5ms对应的计数 = (0.5 / 20) * 200
// 2.5ms对应的计数 = (2.5 / 20) * 200
// 因此,角度从0到180度时,占空比应该从0.5ms到2.5ms线性变化
unsigned int ServoAngle = (unsigned int)((0.5 + (angle / 180.0) * 2.0) / 20.0 * 200);
TIM_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
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
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
在文件bsp_sg90.h中,编写如下代码。
c
/*
* 立创开发板软硬件资料与相关扩展板软硬件资料官网全部开源
* 开发板官网:www.lckfb.com
* 技术支持常驻论坛,任何技术问题欢迎随时交流学习
* 立创论坛:https://oshwhub.com/forum
* 关注bilibili账号:【立创开发板】,掌握我们的最新动态!
* 不靠卖板赚钱,以培养中国工程师为己任
*
Change Logs:
* Date Author Notes
* 2024-03-22 LCKFB-LP first version
*/
#ifndef _BSP_SG90_H
#define _BSP_SG90_H
#include "stm32f4xx.h"
#include "board.h"
#define RCC_SIG RCC_AHB1Periph_GPIOA
#define PORT_SIG GPIOA
#define GPIO_SIG GPIO_Pin_6
#define GPIO_SIG_SOURCE GPIO_PinSource6
#define AF_SIG GPIO_AF_TIM3
#define RCC_SIG_TIMER RCC_APB1Periph_TIM3
#define BSP_SIG_TIMER TIM3 // 定时器
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-03-22 LCKFB-LP first version
*/
#include "board.h"
#include "bsp_uart.h"
#include <stdio.h>
#include "bsp_sg90.h"
int 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
43
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
上电效果:舵机从0度转到180度后,再从0度重新开始转。
模块代码下载链接: