def nanokontrolCallback(self,msg): velocity = (((msg.axes[0])+1)*4) param = ParamValue() param.real = velocity paramReq = ParamSetRequest() paramReq.param_id = 'MPC_XY_CRUISE' paramReq.value = param self.param_service.call(paramReq)
def nanokontrolCallback(self,msg): for key,value in self.paramList.items(): paramVal = (((msg.axes[value])+1)*2.0) print paramVal param = ParamValue() param.real = paramVal paramReq = ParamSetRequest() paramReq.param_id = key paramReq.value = param print key, value, paramVal self.param_service.call(paramReq)
def nanokontrolCallback(self, msg): for key, value in self.paramList.items(): paramVal = (((msg.axes[value]) + 1) * 2.0) print paramVal param = ParamValue() param.real = paramVal paramReq = ParamSetRequest() paramReq.param_id = key paramReq.value = param print key, value, paramVal self.param_service.call(paramReq)
def shutdown(self): # reset original parameters for p in self.default_params: req = ParamSetRequest(p, self.default_params[p]) response = self.set_param_client(req) if not response: rospy.loginfo("[%s] Failed to set %s" % (self.name, p))
def set_rl_mode(self): # get the old values for the parameters we're going to change for p in self.params: self.default_params[p] = self.get_param(p) # set new values for p in self.params: req = ParamSetRequest(p, self.params[p]) response = self.set_param_client(req) if not response: rospy.loginfo("[%s] Failed to set %s" % (self.name, p))