FancySafeBot 0.0.1
A safe robotics library
Loading...
Searching...
No Matches
fsb_spatial.h
1
2#ifndef FSB_SPATIAL_H
3#define FSB_SPATIAL_H
4
5#include "fsb_configuration.h"
6#include "fsb_motion.h"
7#include "fsb_jacobian.h"
8#include <cstddef>
9
10namespace fsb
11{
12
26Transform transform_to_spatial(const Transform& transf);
27
34Transform transform_inverse_to_spatial(const Transform& transf);
35
43MotionVector spatial_space_to_body(const Transform& pose, const MotionVector& velocity_space);
44
52MotionVector spatial_body_to_space(const Transform& pose, const MotionVector& velocity_body);
53
62Jacobian spatial_jacobian_body_to_space(const Transform& pose, const Jacobian& jacobian, size_t columns = MaxSize::dofs);
63
72Jacobian spatial_jacobian_space_to_body(const Transform& pose, const Jacobian& jacobian, size_t columns = MaxSize::dofs);
73
78} // namespace fsb
79
80#endif // FSB_SPATIAL_H
Jacobian spatial_jacobian_body_to_space(const Transform &pose, const Jacobian &jacobian, size_t columns=MaxSize::dofs)
Convert from jacobian in body frame to space frame.
Definition fsb_spatial.cpp:48
MotionVector spatial_body_to_space(const Transform &pose, const MotionVector &velocity_body)
Convert spatial velocity from space frame to body-fixed frame.
Definition fsb_spatial.cpp:37
Transform transform_inverse_to_spatial(const Transform &transf)
Convert inverse of a coordinate transform to spatial transform.
Definition fsb_spatial.cpp:22
Jacobian spatial_jacobian_space_to_body(const Transform &pose, const Jacobian &jacobian, size_t columns=MaxSize::dofs)
Convert from jacobian in space frame to body-fixed frame.
Definition fsb_spatial.cpp:79
Transform transform_to_spatial(const Transform &transf)
Convert coordinate transform to spatial transform.
Definition fsb_spatial.cpp:14
MotionVector spatial_space_to_body(const Transform &pose, const MotionVector &velocity_space)
Convert spatial velocity from body frame to space frame.
Definition fsb_spatial.cpp:27
static constexpr size_t dofs
Maximum number of degrees of freedom.
Definition fsb_configuration.h:49