控制摄像头的代码
import socket
import time
class Control:
def left(self,i):
client = socket.socket()
client.connect(('192.168.1.64', 8100))
client.send(b'\x00\x00\x00\x00\x00\x00\x22\x31\x00\x03\x17\x00\x08')
# 先补6个0,命令一,命令二,数据长度(两位),左转,状态(开始/停止),速度
time.sleep(i)
print('左转',i)
client.close()
def right(self,i):
client = socket.socket()
client.connect(('192.168.1.64', 8100))
client.send(b'\x00\x00\x00\x00\x00\x00\x22\x31\x00\x03\x18\x00\x04')
time.sleep(i)
print('右转',i)
client.close()
def stop(self,i):
client = socket.socket()
client.connect(('192.168.1.64', 8100))
client.send(b'\x00\x00\x00\x00\x00\x00\x22\x31\x00\x03\x17\x01\x04')
time.sleep(i)
print('停转',i)
client.close()
调用控制程序转动一定角度
设了一个假目标,目标距离小于500摄像头就转动,转动方位自定义输入。假设电机转速为每秒30°
import cmath
import math
import numpy as np
from numpy import loadtxt
from control import Control
x = 300
y = float(input('输入方位:'))
if x < 500:
i = y/30
print('应转',i)
# 左转
if y < 0 :
Control().left(-i)
Control().stop(-i)
# 右转
elif y > 0:
Control().right(i)
Control().stop(i)
# 原点
else:
Control().stop(i)
运行结果
输入方位:30
应转 1.0
右转 1.0