本篇文章为大家展示了如何使用树莓派控制舵机MG90D,内容简明扼要并且容易理解,绝对能使你眼前一亮,通过这篇文章的详细介绍希望你能有所收获。
舵机是一种位置(角度)伺服的驱动器,适用于那些需要角度不断变化并可以保持的控制系统。目前,在高档遥控玩具,如飞机、潜艇模型,遥控机器人中已经得到了普遍应用。我们这里使用的淘宝上常见的MG90舵机。如下图,需要注意,不同的型号,其转向的角度,力距不一样,可以根据自己的需求进行选用。
舵机的控制信号由接收机的通道进入信号调制芯片,获得直流偏置电压。它内部有一个基准电路,产生周期为20ms,宽度为1.5ms的基准信号,将获得的直流偏置电压与电位器的电压比较,获得电压差输出。最后,电压差的正负输出到电机驱动芯片决定电机的正反转。当电机转速一定时,通过级联减速齿轮带动电位器旋转,使得电压差为0,电机停止转动。
舵机的控制一般需要一个20ms左右的时基脉冲,该脉冲的高电平部分一般为0.5ms-2.5ms范围内的角度控制脉冲部分,总间隔为2ms。以180度角度伺服为例,那么对应的控制关系是这样的:
脉宽、占空比和舵机转角之间的关系表格:
脉冲/ms | 占空比 | 角度 |
---|---|---|
0.5 | 2.5% | 0 |
1.0 | 5% | 45 |
1.5 | 7.5% | 90 |
2.0 | 10% | 135 |
2.5 | 12.5% | 180 |
在上表的基础上,我们需要计算一些关键参数。
根据上表,如果我们要使舵机转到指定的角度θ(0≤θ≤180)θ(0≤θ≤180) ,则需要输入的脉冲占空比为:
D=2.5+(θ×(12.5−2.5))/180=2.5+(θ×10)/180
舵机转动需要一定时间,给它发指令应避免引起冲突。舵机的转速大概为0.2秒每60度,即0.003s/° 。而舵机的精度为180°/1024≈0.18°,对应的脉冲占空比精度为(12.5−2.5)/1024≈0.01 ,因此,在步进转动内(即每次转0.18°,后面直接取0.2°),给舵机发的指令间隔时间不应该低于0.2×0.003=0.0006s ,舍入一下即0.001s。而如果我们是任意指定转角,那么两次指令的间隔时间则应该长于180×0.260=0.4s,这是从0度转到180度的时间。
将舵机棕色线接到GND,红色线接到+5V引脚,橙色线接到GPIO.12(BCM18)引脚。
Rotation.py
import RPi.GPIO as GPIO
import time
# 这个类表示单个的SG90模块
class Rotation:
frequency=50 #脉冲频率(Hz)
delta_theta=0.2 #步进转动间隔(度)
min_delay=0.0006 #转动delta_theta的理论耗时(s)
max_delay=0.4 #从0转到180的耗时(s)
def __init__(self,channel,min_theta,max_theta,init_theta=0):
'''
构造函数:
channel: 舵机信号线所连接的树莓派引脚编号(BCM编码)
min_theta: 舵机转动的最小角度
max_theta: 舵机转动的最大角度
init_theta: 舵机的初始角度
'''
self.channel=channel
if(min_theta<0 or min_theta>180):
self.min_theta=0
else:
self.min_theta=min_theta
if(max_theta<0 or max_theta>180):
self.max_theta=180
else:
self.max_theta=max_theta
if(init_theta<min_theta or init_theta>max_theta):
self.init_theta=(self.min_theta+self.max_theta)/2
else:
self.init_theta=init_theta #初始角度
#计算最小角度、最大角度的占空比
self.min_dutycycle=2.5+self.min_theta*10/180
self.max_dutycycle=2.5+self.max_theta*10/180
def setup(self):
'''
初始化
'''
GPIO.setmode(GPIO.BCM)
GPIO.setwarnings(False)
GPIO.setup(self.channel,GPIO.OUT)
self.pwm=GPIO.PWM(self.channel,Rotation.frequency) #PWM
self.dutycycle=2.5+self.init_theta*10/180 #脉冲占空比的初始值
self.pwm.start(self.dutycycle) #让舵机转到初始位置
time.sleep(Rotation.max_delay)
def positiveRotation(self):
'''
正相步进转动,每次调用只转动delta_theta度
'''
self.dutycycle=self.dutycycle+Rotation.delta_theta*10/180
if self.dutycycle>self.max_dutycycle:
self.dutycycle=self.max_dutycycle
self.pwm.ChangeDutyCycle(self.dutycycle)
time.sleep(Rotation.min_delay)
def reverseRotation(self):
'''
反相转动,每次调用只转动delta_theta度
'''
self.dutycycle=self.dutycycle-Rotation.delta_theta*10/180
if self.dutycycle<self.min_dutycycle:
self.dutycycle=self.min_dutycycle
self.pwm.ChangeDutyCycle(self.dutycycle)
time.sleep(Rotation.min_delay)
def specifyRotation(self,theta):
'''
转动到指定的角度
'''
if(theta<0 or theta>180):
return
self.dutycycle=2.5+theta*10/180
self.pwm.ChangeDutyCycle(self.dutycycle)
time.sleep(Rotation.max_delay)
def cleanup(self):
self.pwm.stop()
time.sleep(Rotation.min_delay)
GPIO.cleanup()
ServoCtrl.py
import time
rot = Rotation(18, 0, 180)
rot.setup()
time.sleep(2)
for i in range(0,900):
rot.positiveRotation()
for i in range(0,900):
rot.reverseRotation()
rot.cleanup()
上述内容就是如何使用树莓派控制舵机MG90D,你们学到知识或技能了吗?如果还想学到更多技能或者丰富自己的知识储备,欢迎关注亿速云行业资讯频道。
亿速云「云服务器」,即开即用、新一代英特尔至强铂金CPU、三副本存储NVMe SSD云盘,价格低至29元/月。点击查看>>
免责声明:本站发布的内容(图片、视频和文字)以原创、转载和分享为主,文章观点不代表本网站立场,如果涉及侵权请联系站长邮箱:is@yisu.com进行举报,并提供相关证据,一经查实,将立刻删除涉嫌侵权内容。
原文链接:https://my.oschina.net/hechunc/blog/3020284