|
kinematics-dynamics
|
Abstract base class for a cartesian controller.
#include <ICartesianControl.h>
Classes | |
| struct | ControllerState |
| Controller state structure. More... | |
Public Types | |
| enum class | Vocabs { OK = yarp::os::createVocab32('o','k') , FAILED = yarp::os::createVocab32('f','a','i','l') , SET = yarp::os::createVocab32('s','e','t') , GET = yarp::os::createVocab32('g','e','t') , NOT_SET = yarp::os::createVocab32('n','s','e','t') } |
| General-purpose vocabs. More... | |
| enum class | RPC { STATE = yarp::os::createVocab32('s','t','a','t') , INV = yarp::os::createVocab32('i','n','v') , MOVEJ = yarp::os::createVocab32('m','o','v','j') , MOVEL = yarp::os::createVocab32('m','o','v','l') , MOVEV = yarp::os::createVocab32('m','o','v','v') , GCMP = yarp::os::createVocab32('g','c','m','p') , FORCE = yarp::os::createVocab32('f','o','r','c') , STOP = yarp::os::createVocab32('s','t','o','p') , TOOL = yarp::os::createVocab32('t','o','o','l') , ACT = yarp::os::createVocab32('a','c','t') } |
| RPC vocabs. More... | |
| enum class | Streaming { POSE = yarp::os::createVocab32('p','o','s','e') , TWIST = yarp::os::createVocab32('t','w','s','t') , WRENCH = yarp::os::createVocab32('w','r','n','c') } |
| Streaming vocabs. More... | |
| enum class | Mode { NONE = yarp::os::createVocab32('n','c','t','l') , MOVEJ = yarp::os::createVocab32('m','o','v','j') , MOVEL = yarp::os::createVocab32('m','o','v','l') , MOVEV = yarp::os::createVocab32('m','o','v','v') , GCMP = yarp::os::createVocab32('g','c','m','p') , FORCE = yarp::os::createVocab32('f','o','r','c') } |
| Controller mode vocabs. More... | |
| enum class | Actuator { NONE = yarp::os::createVocab32('a','c','n') , CLOSE = yarp::os::createVocab32('a','c','c','g') , OPEN = yarp::os::createVocab32('a','c','o','g') , STOP = yarp::os::createVocab32('a','c','s','g') , GENERIC = yarp::os::createVocab32('a','c','g') } |
| Actuator control vocabs. More... | |
| enum class | Config { GAIN = yarp::os::createVocab32('c','p','c','g') , TRAJ_DURATION = yarp::os::createVocab32('c','p','t','d') , TRAJ_REF_SPD = yarp::os::createVocab32('c','p','t','s') , TRAJ_REF_ACC = yarp::os::createVocab32('c','p','t','a') , CMC_PERIOD = yarp::os::createVocab32('c','p','c','p') , FRAME = yarp::os::createVocab32('c','p','f') , STREAMING_CMD = yarp::os::createVocab32('c','p','s','c') } |
| Controller configuration vocabs. More... | |
Public Member Functions | |
| virtual | ~ICartesianControl ()=default |
| Destructor. | |
| virtual bool | stat (std::vector< double > &x, int *state=nullptr, double *timestamp=nullptr) |
| virtual bool | inv (const std::vector< double > &xd, std::vector< double > &q) |
| virtual bool | movj (const std::vector< double > &xd) |
| virtual bool | relj (const std::vector< double > &xd) |
| virtual bool | movl (const std::vector< double > &xd) |
| virtual bool | movv (const std::vector< double > &xdotd) |
| virtual bool | gcmp () |
| virtual bool | forc (const std::vector< double > &fd) |
| virtual bool | wait (double timeout=0.0) |
| virtual bool | tool (const std::vector< double > &x) |
| virtual bool | act (int command) |
| virtual bool | setParameter (int vocab, double value) |
| virtual bool | getParameter (int vocab, double *value) |
| virtual bool | setParameters (const std::map< int, double > ¶ms) |
| virtual bool | getParameters (std::map< int, double > ¶ms) |
RPC commands | |
| virtual yarp::dev::ReturnValue | getState (ControllerState &state)=0 |
| Current state and position. | |
| virtual yarp::dev::ReturnValue | solvePose (const std::vector< double > &xd, std::vector< double > &q)=0 |
| Inverse kinematics. | |
| virtual yarp::dev::ReturnValue | moveJoint (const std::vector< double > &xd)=0 |
| Move in joint space. | |
| virtual yarp::dev::ReturnValue | moveLinear (const std::vector< double > &xd)=0 |
| Linear move to target position. | |
| virtual yarp::dev::ReturnValue | moveVelocity (const std::vector< double > &xdotd)=0 |
| Linear move with given velocity. | |
| virtual yarp::dev::ReturnValue | gravityCompensation ()=0 |
| Gravity compensation. | |
| virtual yarp::dev::ReturnValue | forceControl (const std::vector< double > &fd)=0 |
| Force control. | |
| virtual yarp::dev::ReturnValue | stopControl ()=0 |
| Stop control. | |
| virtual yarp::dev::ReturnValue | changeTool (const std::vector< double > &x)=0 |
| Change tool. | |
| virtual yarp::dev::ReturnValue | actuateTool (Actuator command)=0 |
| Actuate tool. | |
Streaming commands | |
| virtual void | pose (const std::vector< double > &x)=0 |
| Achieve pose. | |
| virtual void | twist (const std::vector< double > &xdot)=0 |
| Instantaneous velocity steps. | |
| virtual void | wrench (const std::vector< double > &w)=0 |
| Exert force. | |
Configuration accessors | |
| virtual yarp::dev::ReturnValue | setParameter (Config vocab, double value)=0 |
| Set a configuration parameter. | |
| virtual yarp::dev::ReturnValue | getParameter (Config vocab, double *value)=0 |
| Retrieve a configuration parameter. | |
| virtual yarp::dev::ReturnValue | setParameters (const std::map< Config, double > ¶ms)=0 |
| Set multiple configuration parameters. | |
| virtual yarp::dev::ReturnValue | getParameters (std::map< Config, double > ¶ms)=0 |
| Retrieve multiple configuration parameters. | |
|
strong |
|
strong |
Used by configuration accessors.
|
strong |
Used by ICartesianControl::getState to reflect current control mode.
| Enumerator | |
|---|---|
| NONE | Not controlling. |
| MOVEJ | Executing MOVEJ command. |
| MOVEL | Executing MOVEL command. |
| MOVEV | Executing MOVEV command. |
| GCMP | Executing GCMP command. |
| FORCE | Executing FORCE command. |
|
strong |
Used by RPC commands.
|
strong |
Used by streaming commands.
| Enumerator | |
|---|---|
| POSE | Achieve pose. |
| TWIST | Instantaneous velocity steps. |
| WRENCH | Exert force. |
|
strong |
|
pure virtual |
Send control command to actuate the robot's tool, if available.
| command | One of the available ICartesianControl::Actuator vocabs. |
Implemented in BasicCartesianControl, CartesianControlClient, and CartesianControlClientROS2.
|
pure virtual |
Unload current tool if any and append new tool frame to the kinematic chain.
| x | 6-element vector describing new tool tip with regard to current end-effector frame in cartesian space; first three elements denote translation (meters), last three denote rotation in scaled axis-angle representation (radians). |
Implemented in BasicCartesianControl, CartesianControlClient, and CartesianControlClientROS2.
|
pure virtual |
Apply desired forces in task space.
| fd | 6-element vector describing desired force exerted by the TCP in cartesian space; first three elements denote linear force (Newton), last three denote torque (Newton*meters). |
Implemented in BasicCartesianControl, CartesianControlClient, and CartesianControlClientROS2.
|
pure virtual |
Ask the controller to retrieve a parameter of 'double' type.
| vocab | YARP-encoded vocab (parameter key). |
| value | Parameter value encoded as a double. |
Implemented in BasicCartesianControl, CartesianControlClient, and CartesianControlClientROS2.
|
pure virtual |
Ask the controller to retrieve all available parameters at once.
| params | Dictionary of YARP-encoded vocabs as keys and their values. |
|
pure virtual |
Inform on control state, get robot position and perform forward kinematics.
| state | Controller state data. |
Implemented in BasicCartesianControl, CartesianControlClient, and CartesianControlClientROS2.
|
pure virtual |
Enable gravity compensation.
Implemented in BasicCartesianControl, CartesianControlClient, and CartesianControlClientROS2.
|
pure virtual |
Perform inverse kinematics and move to desired position in joint space using absolute coordinates.
| xd | 6-element vector describing desired position in cartesian space; first three elements denote translation (meters), last three denote rotation in scaled axis-angle representation (radians). |
Implemented in BasicCartesianControl, CartesianControlClient, and CartesianControlClientROS2.
|
pure virtual |
Move to end position along a line trajectory.
| xd | 6-element vector describing desired position in cartesian space; first three elements denote translation (meters), last three denote rotation in scaled axis-angle representation (radians). |
Implemented in BasicCartesianControl, CartesianControlClient, and CartesianControlClientROS2.
|
pure virtual |
Move along a line with constant velocity.
| xdotd | 6-element vector describing desired velocity in cartesian space; first three elements denote translational velocity (meters/second), last three denote angular velocity (radians/second). |
Implemented in BasicCartesianControl, CartesianControlClient, and CartesianControlClientROS2.
|
pure virtual |
Move to desired position instantaneously, no further intermediate calculations are expected other than computing the inverse kinematics.
| x | 6-element vector describing desired instantaneous pose in cartesian space; first three elements denote translation (meters), last three denote rotation in scaled axis-angle representation (radians). |
Implemented in BasicCartesianControl, CartesianControlClient, and CartesianControlClientROS2.
|
pure virtual |
Ask the controller to store or update a parameter of 'double' type.
| vocab | YARP-encoded vocab (parameter key). |
| value | Parameter value encoded as a double. |
Implemented in BasicCartesianControl, CartesianControlClient, and CartesianControlClientROS2.
|
pure virtual |
Ask the controller to store or update multiple parameters at once.
| params | Dictionary of YARP-encoded vocabs as keys and their values. |
|
pure virtual |
Perform inverse kinematics (using robot position as initial guess), but do not move.
| xd | 6-element vector describing desired position in cartesian space; first three elements denote translation (meters), last three denote rotation in scaled axis-angle representation (radians). |
| q | Vector describing current position in joint space (meters or degrees). |
Implemented in BasicCartesianControl, CartesianControlClient, and CartesianControlClientROS2.
|
pure virtual |
Halt current control loop if any and cease movement.
Implemented in BasicCartesianControl, CartesianControlClient, and CartesianControlClientROS2.
|
pure virtual |
Move in instantaneous velocity increments.
| xdot | 6-element vector describing velocity increments in cartesian space; first three elements denote translational velocity (meters/second), last three denote angular velocity (radians/second). |
Implemented in BasicCartesianControl, CartesianControlClient, and CartesianControlClientROS2.
|
pure virtual |
Make the TCP exert the desired force instantaneously.
| w | 6-element vector describing desired force exerted by the TCP in cartesian space; first three elements denote linear force (Newton), last three denote torque (Newton*meters). |
Implemented in BasicCartesianControl, CartesianControlClient, and CartesianControlClientROS2.