FancySafeBot 0.0.1
A safe robotics library
Loading...
Searching...
No Matches
fsb_kinematic_redundancy.h
1
2#ifndef FSB_KINEMATICS_REDUNDANCY_H
3#define FSB_KINEMATICS_REDUNDANCY_H
4
5#include "fsb_joint.h"
6#include "fsb_linalg.h"
7#include "fsb_jacobian.h"
8
9namespace fsb
10{
11
37FsbLinalgErrorType jacobian_pseudoinverse(const Jacobian& jacobian, Jacobian& inverse_jacobian, size_t dofs);
38
63JointSpace compute_nullspace_motion(const Jacobian& jacobian, const Jacobian& inverse_jacobian, const JointSpace& joint_motion, size_t dofs);
64
74JointSpace compute_nullspace_motion(const Jacobian& jacobian, const JointSpace& joint_motion, size_t dofs);
75
80} // namespace fsb
81
82#endif
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.