您最多选择25个主题
主题必须以中文或者字母或数字开头，可以包含连字符 (-)，并且长度不得超过35个字符
27 行
624 B
27 行
624 B
#!/usr/bin/env python
|
|
|
|
from __future__ import print_function
|
|
|
|
import random
|
|
import rospy
|
|
|
|
from robotics_demo.srv import PositionService, PositionServiceResponse
|
|
|
|
|
|
def new_position(req):
|
|
print("Request: \n{}".format(req.input))
|
|
req.input.pos_x = random.uniform(-4.0, 4.0)
|
|
req.input.pos_z = random.uniform(-4.0, 4.0)
|
|
|
|
return PositionServiceResponse(req.input)
|
|
|
|
|
|
def translate_position_server():
|
|
rospy.init_node('position_server')
|
|
s = rospy.Service('pos_srv', PositionService, new_position)
|
|
print("Ready to move cubes!")
|
|
rospy.spin()
|
|
|
|
|
|
if __name__ == "__main__":
|
|
translate_position_server()
|