def getObjectsCallback(self, req): res = GetObjectsResponse() if req.localization_type == "dynamic": for i in range(0, len(self.objects)): obj = ObjectMsg() obj.x = self.objects.values()[i].x obj.y = self.objects.values()[i].y obj.message = self.objects.values()[i].message obj.type = self.objects.values()[i].type if req.object_type == self.objects.values()[i].type or req.object_type == "all" or req.object_type == "": if obj.message in res.objects: continue res.objects.append(obj) elif req.localization_type == "static": for i in range(0, len(self.static_objects)): obj = ObjectMsg() obj.x = static_objects[i].x obj.y = static_objects[i].y obj.message = static_objects[i].message obj.type = static_objects[i].type res.objects.append(obj) elif req.localization_type == "all": for i in range(0, len(self.objects)): obj = ObjectMsg() obj.x = self.objects.values()[i].x obj.y = self.objects.values()[i].y obj.message = self.objects.values()[i].message obj.type = self.objects.values()[i].type if req.object_type == self.objects.values()[i].type or req.object_type == "all" or req.object_type == "": if obj.message in res.objects: continue res.objects.append(obj) for i in range(0, len(self.static_objects)): obj = ObjectMsg() obj.x = static_objects[i].x obj.y = static_objects[i].y obj.message = static_objects[i].message obj.type = static_objects[i].type res.objects.append(obj) else: print "No such type" res.success = True print res.objects return res
def setObjectClient():
obj = ObjectMsg()
obj.x = x
obj.y = y
obj.message = msg
obj.type = type
rospy.wait_for_service('set_object')
try:
set_object = rospy.ServiceProxy('set_object', SetObject)
resp1 = set_object(obj)
return resp1.success
except rospy.ServiceException, e:
print "Service call failed: %s"%e