kenaug74/mycobot_ros
1
0
Fork 0
mirror of https://github.com/elephantrobotics/mycobot_ros.git synced 2026-07-05 19:47:04 +00:00
Code Issues Projects Releases Packages Wiki Activity Actions

add aikit-320 ros

Browse source
This commit is contained in:
weijian 2023-06-13 14:34:43 +08:00
parent 452edcaebb
commit 383a82f5e6
1 changed files with 25 additions and 19 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

6
mycobot_320/mycobot_320_communication/scripts/mycobot_topics_pi.py
View file

@ -151,6 +151,7 @@ class MycobotTopics(object):
pub = rospy.Publisher("mycobot/angles_real", MycobotAngles, queue_size=5)
ma = MycobotAngles()
while not rospy.is_shutdown():
if self.mc:
self.lock.acquire()
angles = self.mc.get_angles()
self.lock.release()
@ -172,6 +173,7 @@ class MycobotTopics(object):
while not rospy.is_shutdown():
# self.lock.acquire()
if self.mc:
lock = acquire("/tmp/mycobot_lock")
coords = self.mc.get_coords()
# self.lock.release()
@ -199,6 +201,7 @@ class MycobotTopics(object):
data.joint_6,
]
sp = int(data.speed)
if self.mc:
lock = acquire("/tmp/mycobot_lock")
self.mc.send_angles(angles, sp)
release(lock)
@ -213,6 +216,7 @@ class MycobotTopics(object):
angles = [data.x, data.y, data.z, data.rx, data.ry, data.rz]
sp = int(data.speed)
model = int(data.model)
if self.mc:
lock = acquire("/tmp/mycobot_lock")
self.mc.send_coords(angles, sp, model)
release(lock)
@ -227,10 +231,12 @@ class MycobotTopics(object):
"""订阅夹爪状态"""
def callback(data):
if data.Status:
if self.mc:
lock = acquire("/tmp/mycobot_lock")
self.mc.set_gripper_state(0, 80)
release(lock)
else:
if self.mc:
lock = acquire("/tmp/mycobot_lock")
self.mc.set_gripper_state(1, 80)
release(lock)