发 帖  
原厂入驻New

DIY人脸跟踪电风扇送女朋友(2)

2020-9-24 08:48:39  195 DIY
分享
1


接着之前的内容,我们来编写一下云台控制的代码。实际上由于安装了开源的Adafruit_Python_PCA9685模块,操作舵机非常的简单。这里我们把舵机的控制分成x轴和y轴,x轴可以像左或者向由旋转一定的角度。y轴可以向上或者向下旋转一定的角度。所以舵机控制的接口定义为:
# direction 控制方向,对应x轴的left或者right, y轴的up和down
def ServoControl(channel, direction, angle):
# 如果想让云台像左转动15度,如下调用方式:
ServoControl('y', 'up', 20)
# 如果想让云台恢复到水平中间位置,如下调用方式:
ServoControl('y', 'up', 0) #'down' 也可以
下面是完整的舵机控制代码:
from __future__ import division
import time
import Adafruit_PCA9685
import threading

plus_y_up = 350
plus_y_down = 550
plus_y_middle = int((plus_y_up + plus_y_down) / 2)
plus_y_half = int((plus_y_down - plus_y_up) / 2)
plus_y_current = plus_y_middle

plus_x_left = 600
plus_x_right = 150
plus_x_middle = int((plus_x_left + plus_x_right) / 2)
plus_x_half = int((plus_x_left - plus_x_right) / 2)
plus_x_current = plus_x_middle

pwm = None

def ServoInit():
    global pwm
    pwm = Adafruit_PCA9685.PCA9685()
    pwm.set_pwm_freq(60)
    pwm.set_pwm(0, 0, plus_x_current)
    pwm.set_pwm(1, 0, plus_y_current)

def ServoControl(channel, direction, angle):
    global pwm
    angle_max = 45
    if angle > angle_max:
        angle = angle_max
    ratio = float(angle) / angle_max

    if channel == 'x':
        if direction == 'right':
            plus = plus_x_middle - int(plus_x_half * ratio)
        if direction == 'left':
            plus = plus_x_middle + int(plus_x_half * ratio)
        print(plus)
        pwm.set_pwm(0, 0, plus)

    if channel == 'y':
        if direction == 'up':
            plus = plus_y_middle - int(plus_y_half * ratio)
        if direction == 'down':
            plus = plus_y_middle + int(plus_y_half * ratio)
        print(plus)
        pwm.set_pwm(1, 0, plus)


if __name__ == '__main__':
    while True:
        ServoControl('x', 'right', 45)        
        time.sleep(1)
        ServoControl('x', 'right', 0)        
        time.sleep(1)
        ServoControl('x', 'left', 45)
        time.sleep(1)

张和生 2020-9-24 17:56:09
你这个功能,能实现吗?
1回复

举报

评论

高级模式
您需要登录后才可以回帖 登录 | 注册

声明:本文内容及配图由入驻作者撰写或者入驻合作网站授权转载。文章观点仅代表作者本人,不代表电子发烧友网立场。文章及其配图仅供工程师学习之用,如有内容图片侵权或者其他问题,请联系本站作侵删。 侵权投诉
发经验
关闭

站长推荐 上一条 /8 下一条

快速回复 返回顶部 返回列表