This commit is contained in:
wangWking 2022-05-10 11:10:38 +08:00
parent d3f50a768b
commit 3aa412babd

View file

@ -17,21 +17,20 @@ from pymycobot.mycobot import MyCobot
mc = None mc = None
def callback(data): def callback(data):
# rospy.loginfo(rospy.get_caller_id() + "%s", data.position) # rospy.loginfo(rospy.get_caller_id() + "%s", data.position)
# print('data_position======================>',data.position)
data_list = [] data_list = []
for index, value in enumerate(data.position): for index, value in enumerate(data.position):
data_list.append(value) data_list.append(value)
mc.send_radians(data_list, 80) mc.send_radians(data_list, 80)
# print('data_list=====================>',data_list)
# time.sleep(0.5) # time.sleep(0.5)
def listener(): def listener():
global mc global mc
rospy.init_node("control_slider", anonymous=True) rospy.init_node("control_slider", anonymous=True)
rospy.Subscriber("joint_states", JointState, callback) rospy.Subscriber("joint_states", JointState, callback)
@ -39,11 +38,11 @@ def listener():
baud = rospy.get_param("~baud", 115200) baud = rospy.get_param("~baud", 115200)
print(port, baud) print(port, baud)
mc = MyCobot(port, baud) mc = MyCobot(port, baud)
# spin() simply keeps python from exiting until this node is stopped # spin() simply keeps python from exiting until this node is stopped
print("spin ...") print("spin ...")
rospy.spin() rospy.spin()
if __name__ == "__main__": if __name__ == "__main__":
listener() listener()