Browse Source

Add is_moving to joint state

feature/grasp_object_select
Binit Shah 1 year ago
parent
commit
84b81e0fec
1 changed files with 3 additions and 2 deletions
  1. +3
    -2
      hello_helpers/src/hello_helpers/hello_misc.py

+ 3
- 2
hello_helpers/src/hello_helpers/hello_misc.py View File

@ -182,12 +182,13 @@ class HelloNode:
assert(self._point_cloud is not None) assert(self._point_cloud is not None)
return self._point_cloud return self._point_cloud
def get_joint_state(self, joint_name):
def get_joint_state(self, joint_name, moving_threshold=0.001):
i = self._joint_states.name.index(joint_name) i = self._joint_states.name.index(joint_name)
joint_position = self._joint_states.position[i] joint_position = self._joint_states.position[i]
joint_velocity = self._joint_states.velocity[i] joint_velocity = self._joint_states.velocity[i]
joint_effort = self._joint_states.effort[i] joint_effort = self._joint_states.effort[i]
return (joint_position, joint_velocity, joint_effort)
joint_is_moving = abs(joint_velocity) > moving_threshold
return (joint_position, joint_velocity, joint_effort, joint_is_moving)
def get_tool(self): def get_tool(self):
assert(self._tool is not None) assert(self._tool is not None)

Loading…
Cancel
Save