The service is initialized here:
|
self.srvs['move_to_init_joint_state'] = self.node.Service(f'rpbi/{self.name}/move_to_initial_joint_state', ResetJointState, self.service_move_to_initial_joint_state) |
This uses the ResetJointState service template. However, the joint_state in the service request is ignored (the initial joint state is retrieved from the configuration file).
When calling the service it requires the user to pass an empty JointState message, as follows
duration = 5.0 # secs
resp = srv_handler(JointState(), duration)
Ideally this should be
duration = 5.0 # secs
resp = srv_handler(duration)