mirror of
https://github.com/elephantrobotics/mycobot_ros.git
synced 2026-07-05 19:47:04 +00:00
update pump
This commit is contained in:
parent
c457523fec
commit
9842ff2057
4 changed files with 15 additions and 15 deletions
|
|
@ -133,23 +133,23 @@ class Object_detect(Movement):
|
|||
# pump_control pi
|
||||
def gpio_status(self, flag):
|
||||
if flag:
|
||||
# self.GPIO.output(20, 0)
|
||||
self.GPIO.output(20, 0)
|
||||
self.GPIO.output(21, 0)
|
||||
else:
|
||||
# self.GPIO.output(20, 1)
|
||||
self.GPIO.output(20, 1)
|
||||
self.GPIO.output(21, 1)
|
||||
|
||||
# 开启吸泵 m5
|
||||
def pump_on(self):
|
||||
# 让2号位工作
|
||||
# self.mc.set_basic_output(2, 0)
|
||||
self.mc.set_basic_output(2, 0)
|
||||
# 让5号位工作
|
||||
self.mc.set_basic_output(5, 0)
|
||||
|
||||
# 停止吸泵 m5
|
||||
def pump_off(self):
|
||||
# 让2号位停止工作
|
||||
# self.mc.set_basic_output(2, 1)
|
||||
self.mc.set_basic_output(2, 1)
|
||||
# 让5号位停止工作
|
||||
self.mc.set_basic_output(5, 1)
|
||||
|
||||
|
|
|
|||
|
|
@ -20,7 +20,7 @@ class Detect_marker():
|
|||
#initialize MyCobot
|
||||
self.mc = MyCobot(PI_PORT, PI_BAUD)
|
||||
GPIO.setmode(GPIO.BCM)
|
||||
# GPIO.setup(20, GPIO.OUT)
|
||||
GPIO.setup(20, GPIO.OUT)
|
||||
GPIO.setup(21, GPIO.OUT)
|
||||
# set cache of real coord
|
||||
self.cache_x = self.cache_y = 0
|
||||
|
|
@ -74,10 +74,10 @@ class Detect_marker():
|
|||
# 控制吸泵
|
||||
def pub_pump(self, flag):
|
||||
if flag:
|
||||
# GPIO.output(20, 0)
|
||||
GPIO.output(20, 0)
|
||||
GPIO.output(21, 0)
|
||||
else:
|
||||
# GPIO.output(20, 1)
|
||||
GPIO.output(20, 1)
|
||||
GPIO.output(21, 1)
|
||||
|
||||
# Grasping motion
|
||||
|
|
|
|||
|
|
@ -121,23 +121,23 @@ class Object_detect(Movement):
|
|||
# pump_control pi
|
||||
def gpio_status(self, flag):
|
||||
if flag:
|
||||
# self.GPIO.output(20, 0)
|
||||
self.GPIO.output(20, 0)
|
||||
self.GPIO.output(21, 0)
|
||||
else:
|
||||
# self.GPIO.output(20, 1)
|
||||
self.GPIO.output(20, 1)
|
||||
self.GPIO.output(21, 1)
|
||||
|
||||
# 开启吸泵 m5
|
||||
def pump_on(self):
|
||||
# 让2号位工作
|
||||
# self.mc.set_basic_output(2, 0)
|
||||
self.mc.set_basic_output(2, 0)
|
||||
# 让5号位工作
|
||||
self.mc.set_basic_output(5, 0)
|
||||
|
||||
# 停止吸泵 m5
|
||||
def pump_off(self):
|
||||
# 让2号位停止工作
|
||||
# self.mc.set_basic_output(2, 1)
|
||||
self.mc.set_basic_output(2, 1)
|
||||
# 让5号位停止工作
|
||||
self.mc.set_basic_output(5, 1)
|
||||
|
||||
|
|
|
|||
|
|
@ -97,23 +97,23 @@ class Object_detect():
|
|||
# pump_control pi
|
||||
def gpio_status(self, flag):
|
||||
if flag:
|
||||
# self.GPIO.output(20, 0)
|
||||
self.GPIO.output(20, 0)
|
||||
self.GPIO.output(21, 0)
|
||||
else:
|
||||
# self.GPIO.output(20, 1)
|
||||
self.GPIO.output(20, 1)
|
||||
self.GPIO.output(21, 1)
|
||||
|
||||
# 开启吸泵 m5
|
||||
def pump_on(self):
|
||||
# 让2号位工作
|
||||
# self.mc.set_basic_output(2, 0)
|
||||
self.mc.set_basic_output(2, 0)
|
||||
# 让5号位工作
|
||||
self.mc.set_basic_output(5, 0)
|
||||
|
||||
# 停止吸泵 m5
|
||||
def pump_off(self):
|
||||
# 让2号位停止工作
|
||||
# self.mc.set_basic_output(2, 1)
|
||||
self.mc.set_basic_output(2, 1)
|
||||
# 让5号位停止工作
|
||||
self.mc.set_basic_output(5, 1)
|
||||
|
||||
|
|
|
|||
Loading…
Add table
Reference in a new issue