使用树莓派控制舵机MG90D

舵机介绍

舵机是一种位置(角度)伺服的驱动器,适用于那些需要角度不断变化并可以保持的控制系统。目前,在高档遥控玩具,如飞机、潜艇模型,遥控机器人中已经得到了普遍应用。我们这里使用的淘宝上常见的MG90舵机。如下图,需要注意,不同的型号,其转向的角度,力距不一样,可以根据自己的需求进行选用。

使用树莓派控制舵机MG90D_第1张图片

工作原理

舵机的控制信号由接收机的通道进入信号调制芯片,获得直流偏置电压。它内部有一个基准电路,产生周期为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)引脚。
使用树莓派控制舵机MG90D_第2张图片

程序编写

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_thetamax_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.dutycycle180):
            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()

转载于:https://my.oschina.net/hechunc/blog/3020284

你可能感兴趣的:(使用树莓派控制舵机MG90D)