Struct arcos_kdl::inverse_diff_kinematics::InverseDiffKinematicsSolver

pub struct InverseDiffKinematicsSolver { /* fields omitted */ }

Solver for inverse differential kinematcs. Calculate the joints rates from their current position and desired velocity at end-effector

chain: chain to use by the solver
weight_task_space: Weights in the task space
weight_joint_space: How much to use each joint
jacobian: Jacobian of the current chain
temp_qdots: Temporal storage of qdot values
svd_result: For calculating SVD
lambda: parameter for tresholding singular values
epsilon: (1e-300) allowed error in convergence of singular values
maxiter: (150)Max allowed iteration for convergence of SV
n_joints: Number of joints in the kinematic chain\

Implementations

impl InverseDiffKinematicsSolver

pub fn new(in_chain: Chain) -> Self

Create a new solver from a given chain

pub fn set_weights(
    &mut self,
    task_space: WeightTaskSpace,
    joint_space: WeightJointSpace
)

Set the weight matrices for inverse kinematics

pub fn set_lambda(&mut self, new_lambda: f64)

Set the Lambda parameter

pub fn set_convergence(&mut self, new_epsilon: f64, new_maxiter: usize)

Set parameters for convergence algorithm

pub fn solve(
    &mut self,
    twist: &Twist,
    init_angles: &Vec<f64>
) -> Result<Vec<f64>, &str>

Solver for inverse differential kinematics

This function uses the weighted damped least square inverse kinematics algorithm. From a Twist and current joint state, it calculates the velocities at each joint.

twist: desired twist at the end effector
init_angles: current state of each joint
Returns a result closure vector with the velocities at each joint.

Trait Implementations

impl Clone for InverseDiffKinematicsSolver

fn clone(&self) -> InverseDiffKinematicsSolver

Returns a copy of the value.

fn clone_from(&mut self, source: &Self)

Performs copy-assignment from source.

impl Debug for InverseDiffKinematicsSolver

fn fmt(&self, f: &mut Formatter<'_>) -> Result

Formats the value using the given formatter.