interfaces.kinematics

Kinematics interface

get_ik_tool_link_pose

Use the given forward_kinematics function to compute ik_tool_link pose based on current joint configurations in pybullet.

get_ik_generator

get an ik generator

sample_tool_ik

sample ik joints for a given tcp pose in the world frame

compute_forward_kinematics

use the given fk function to compute FK

compute_inverse_kinematics

compute ik solutions using the given ik function handle

select_solution

select one joint configuration given a list of them