concepts.simulator.pybullet.control_utils.get_joint_imp_control_command#

get_joint_imp_control_command(q, dq, target_q, target_dq=None, config=None)[source]#

Joint-space impedance control. It uses goal joint states from the feedback thread and current robot states from the subscribed messages to compute joint torques.

Implementation is based on a simplified version of: https://github.com/NVIDIA-Omniverse/orbit/blob/57e766cf68c942191a74e24269b780ee9a817535/source/extensions/omni.isaac.orbit/omni/isaac/orbit/controllers/joint_impedance.py

Parameters:
  • q (ndarray) – current joint positions.

  • dq (ndarray) – current joint velocities.

  • target_q (ndarray) – goal joint positions.

  • target_dq (ndarray | None) – goal joint velocities.

  • config (dict | None) – control parameters.