36#include <dqrobotics/robot_modeling/DQ_SerialManipulator.h>
38namespace marinholab::sas::core::modeling
45using DQ_robotics::DQ_JointType;
46using DQ_robotics::DQ_SerialManipulator;
57class SerialManipulatorSimulatorFriendly :
public DQ_SerialManipulator
72 std::vector<DQ> offset_before_;
73 std::vector<DQ> offset_after_;
74 std::vector<ActuationType> actuation_types_;
76 DQ
_get_w(
const int& ith)
const;
77 DQ _joint_transformation(
const double& q,
const int& ith)
const;
91 const std::vector<ActuationType>& actuation_types);
93 using DQ_SerialManipulator::raw_fkm;
94 using DQ_SerialManipulator::raw_pose_jacobian;
95 using DQ_SerialManipulator::raw_pose_jacobian_derivative;
109 Eigen::MatrixXd
raw_pose_jacobian(
const Eigen::VectorXd& q_vec,
const int& to_ith_link)
const override;
118 const int& to_ith_link)
const override;
125 DQ
raw_fkm(
const Eigen::VectorXd& q_vec,
const int& to_ith_link)
const override;
A serial manipulator whose joints carry explicit pre/post offsets.
Definition serial_manipulator_simulator_friendly.hpp:58
Eigen::MatrixXd raw_pose_jacobian(const Eigen::VectorXd &q_vec, const int &to_ith_link) const override
Raw pose Jacobian of the chain up to a given link.
Definition serial_manipulator_simulator_friendly.cpp:164
Eigen::MatrixXd raw_pose_jacobian_derivative(const Eigen::VectorXd &q, const Eigen::VectorXd &q_dot, const int &to_ith_link) const override
Time derivative of the raw pose Jacobian.
Definition serial_manipulator_simulator_friendly.cpp:186
DQ _get_w(const int &ith) const
Returns the spatial axis (as a dual quaternion) of the joint.
Definition serial_manipulator_simulator_friendly.cpp:124
DQ raw_fkm(const Eigen::VectorXd &q_vec, const int &to_ith_link) const override
Raw forward kinematics of the chain up to a given link.
Definition serial_manipulator_simulator_friendly.cpp:150
ActuationType
The actuation type and axis of a single joint.
Definition serial_manipulator_simulator_friendly.hpp:62
@ TZ
Translation along the z-axis.
Definition serial_manipulator_simulator_friendly.hpp:66
@ RZ
Revolution about the z-axis.
Definition serial_manipulator_simulator_friendly.hpp:63
@ TX
Translation along the x-axis.
Definition serial_manipulator_simulator_friendly.hpp:68
@ RY
Revolution about the y-axis.
Definition serial_manipulator_simulator_friendly.hpp:64
@ TY
Translation along the y-axis.
Definition serial_manipulator_simulator_friendly.hpp:67
@ RX
Revolution about the x-axis.
Definition serial_manipulator_simulator_friendly.hpp:65
std::vector< DQ_JointType > get_supported_joint_types() const override
Joint types this model can represent.
Definition serial_manipulator_simulator_friendly.cpp:226