forked from Danfoa/robotiq_2finger_grippers
-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathserver_endpoint.py
28 lines (22 loc) · 1.03 KB
/
server_endpoint.py
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
#!/usr/bin/env python
import rospy
from ros_tcp_endpoint import TcpServer, RosPublisher, RosSubscriber, RosService
from ur3_moveit.msg import *
from ur3_moveit.srv import *
from ur3_moveit.msg import UR3MoveitJoints as URMoveitJoints
from robotiq_2f_gripper_msgs.msg import RobotiqGripperCommand as RobotiqGripperCommand
def main():
ros_node_name = rospy.get_param("/TCP_NODE_NAME", 'TCPServer')
tcp_server = TcpServer(ros_node_name)
rospy.init_node(ros_node_name, anonymous=True)
# Start the Server Endpoint with a ROS communication objects dictionary for routing messages
tcp_server.start({
'UR3Trajectory': RosSubscriber('UR3Trajectory', UR3Trajectory, tcp_server),
'ur3_moveit': RosService('ur3_moveit', MoverService),
'ur3_joints': RosSubscriber ('ur3_joints', URMoveitJoints ,tcp_server),
'gripper': RosSubscriber ('gripper', RobotiqGripperCommand ,tcp_server),
})
print("AAAAAAAAAAAAAAAA")
rospy.spin()
if __name__ == "__main__":
main()