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))
