Пример #1
0
 def endpoint_state_cb(self, msg):
   force = vector_msg_to_np(msg.wrench.force)
   torque = vector_msg_to_np(msg.wrench.torque)
   self.wrench = np.hstack((force, torque))
   self.jnt_pos_filt = np.array(msg.joint_state.position)
   if not self.state_alive:
     self.state_alive = True
Пример #2
0
 def ft_sensor_cb(self, msg):
   force = vector_msg_to_np(msg.wrench.force)
   torque = vector_msg_to_np(msg.wrench.torque)
   self.wrench = np.hstack((force, torque))
Пример #3
0
 def est_force_cb(self, msg):
   force = vector_msg_to_np(msg.est_force.force)
   torque = vector_msg_to_np(msg.est_force.torque)
   self.wrench = np.hstack((force, torque))