Get response from ROS services

[Rezenders]

Services responses are not being sent to the agent. This should be implemented.

A possible way to do this would be to publish the response into a topic defined in the action description in action manifest, something like the response field below.

[set_fcu_param]
method = service
name = mavros/param/set
msg_type = mavros_msgs/ParamSet
params_name = param_id, value.integer, value.real
params_type = str, int, float
response = mavros/param/set/response

The response can be treated as a perception:

[set_fcu_param_response]
name = mavros/param/set/response
msg_type = mavros_msgs/ParamSetResponse
args = success, value.integer, value.float
buf = add