美文网首页
遥控双舵机云台(U型遥控器,Python 3,第一人称射击游戏控

遥控双舵机云台(U型遥控器,Python 3,第一人称射击游戏控

作者: TypeY | 来源:发表于2020-04-22 10:35 被阅读0次

像在手机上玩FPS游戏一样遥控你的设备!

总览

这个控件包含两个内容:

1.一个返回手机屏幕上x和y方向滑动量的全屏控件
2.一个简易的图传(我们将在另一篇文章里介绍)

JPEG简易图传

我们可以用它来做什么?

1.作为电脑上的触控板
2.像玩FPS游戏一样控制双舵机云台
3.当然不止以上内容啦..我只提供工具和基本用法,大家自行发挥 :)

这篇文章将会展示一个通过python脚本控制双舵机云台的示例,其他的示例也将会在未来编写添加。

v1.2.8版本以后会分别在按下和弹起时发送downup

接收到的数据示例 常见的双舵机云台

通过树莓派控制由两个9g舵机组成的云台示例

三代树莓派自带的GPIO输出的PWM信号并不稳定,容易照成舵机抖动,这里我们使用第三方的pigpio 库来获取更为稳定的PWM信号输出。

在树莓派上安装pigpio

sudo apt-get install pigpio

导入用到的库并且在尝试初始化pigpio

import pigpio,os,time
from socket import *

try:
    os.system("sudo pigpiod")
    tim.sleep(2)
except:
    pass
    

初始化变量

一般的廉价9g舵机没有任何保护,不建议直接通过树莓派供电,需要根据每个舵机和安装方式测定舵机的最大最小移动范围,防止赌舵照成损失。

#输出pwm信号的两个针脚(对应两个舵机)
s1=27
s2=22
#x,y方向的滑动灵敏度
res_X=1.0
res_Y=1.2
#舵机的初始位置和最大最小移动范围(根据不同舵机修改,实验测得)
s1_m=1240
s2_m=1100
s1_max=2390
s1_min=500
s2_max=2200
s2_min=540
#舵机pwm信号频率
feq=60
#舵机的当前位置=初始位置
ps_1=s1_m
ps_2=s2_m
#初始化
pi = pigpio.pi()
pi.set_PWM_frequency(s1,feq)
pi.set_PWM_frequency(s2,feq)
#set_servo_pulsewidth()函数使我们的舵机的位置变化可以通过无脑的数字叠加实现
pi.set_servo_pulsewidth(s1,s1_m) 
pi.set_servo_pulsewidth(s2,s2_m)

配置UDP

host = '' #保持不变
port = 126 #对应手机上第二行的端口
bufsize = 1024 
addr = (host,port)
udpServer = socket(AF_INET,SOCK_DGRAM) 
udpServer.bind(addr)

定义几个基本的舵机运动控制函数

def stop(): #停止输出pwm信号
    pi.set_servo_pulsewidth(s1,0)
    pi.set_servo_pulsewidth(s2,0)
def mid(): #舵机复位
    global ps_1,ps_2
    ps_1=s1_m
    ps_2=s2_m
    pi.set_servo_pulsewidth(s1,s1_m)
    pi.set_servo_pulsewidth(s2,s2_m)
def set_p(s,p,sm,smax): #设置舵机的位置(s舵机号=pwm输出针脚,p设置的位置,sm当前舵机最小位置,smax最大位置)
    if p>=sm and p<=smax:
        pi.set_servo_pulsewidth(s,int(p))
    elif p>smax:
        p=smax
    elif P<sm:
        p=sm
    return p

接收循环

使用 data.split(";") 拆分数据时,尽可能使用 try+except 来避免接收到意外数据照成的程序崩溃

while 1:
        data,addr = udpServer.recvfrom(bufsize) 
        data=data.decode() 
        if data == "out": #退出
            stop()
            udpServer.close() 
            print("FPS Out")
            break
        elif data == "mid": #复位
            mid()
        else:
            try:
                #print(data)
                data=data.split(";")  #尝试对收到数据进行拆解为x,y方向上的两个值
                data_1=data[0]
                data_2=data[1]
                ps_1=ps_1-int(data_1)*res_X #当前位置=当前位置+-滑动量*灵敏度
                ps_2=ps_2+int(data_2)*res_Y
                ps_1=set_p(s1,ps_1,s1_min,s1_max) #分配位置给舵机
                ps_2=set_p(s2,ps_2,s2_min,s1_max)
            except:
                pass
exit(0)

USwitch端的配置

1.和树莓派处于同一个网络环境

2.设置FPSView,ip设置为树莓派的ip,把端口设置为126(如脚本),注意端口可以更改,尽可能保持独立防止占用

FPSView设置

本教程到此就结束:)

APP下载

从酷安下载

相关文章

网友评论

      本文标题:遥控双舵机云台(U型遥控器,Python 3,第一人称射击游戏控

      本文链接:https://www.haomeiwen.com/subject/zombihtx.html