浏览代码

fixing file mode on main

/fix-file-mode
Hamid Younesy 3 年前
当前提交
a7ae3a29
共有 1 个文件被更改,包括 28 次插入0 次删除
  1. 28
      tutorials/pick_and_place/ROS/src/niryo_moveit/scripts/server_endpoint.py

28
tutorials/pick_and_place/ROS/src/niryo_moveit/scripts/server_endpoint.py


#!/usr/bin/env python
import rospy
from ros_tcp_endpoint import TcpServer, RosPublisher, RosSubscriber, RosService
from niryo_moveit.msg import NiryoMoveitJoints, NiryoTrajectory
from niryo_moveit.srv import MoverService, MoverServiceRequest
from niryo_one_msgs.msg import RobotMoveActionGoal
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({
'SourceDestination_input': RosPublisher('SourceDestination', NiryoMoveitJoints, queue_size=10),
'NiryoTrajectory': RosSubscriber('NiryoTrajectory', NiryoTrajectory, tcp_server),
'niryo_moveit': RosService('niryo_moveit', MoverService),
'niryo_one/commander/robot_action/goal': RosSubscriber('niryo_one/commander/robot_action/goal', RobotMoveActionGoal, tcp_server),
'sim_real_pnp': RosPublisher('sim_real_pnp', MoverServiceRequest)
})
rospy.spin()
if __name__ == "__main__":
main()
正在加载...
取消
保存