2#ifndef FSB_KINEMATICS_REDUNDANCY_H
3#define FSB_KINEMATICS_REDUNDANCY_H
7#include "fsb_jacobian.h"
63JointSpace
compute_nullspace_motion(
const Jacobian& jacobian,
const Jacobian& inverse_jacobian,
const JointSpace& joint_motion,
size_t dofs);
FsbLinalgErrorType jacobian_pseudoinverse(const Jacobian &jacobian, Jacobian &inverse_jacobian, size_t dofs)
Computes the pseudoinverse of a Jacobian matrix.
Definition fsb_kinematic_redundancy.cpp:15
JointSpace compute_nullspace_motion(const Jacobian &jacobian, const Jacobian &inverse_jacobian, const JointSpace &joint_motion, size_t dofs)
Computes nullspace motion using the Jacobian and its pseudoinverse.
Definition fsb_kinematic_redundancy.cpp:71
enum FsbLapackErrorType FsbLinalgErrorType
Error codes for linear algebra functions.