dynamixelAX12Ftdi: Documentation to be added
More...
#include <DynamixelAX12Ftdi/DynamixelAX12FtdiDriver.h>
Inheritance diagram for DynamixelAX12FtdiDriver:dynamixelAX12Ftdi: Documentation to be added
Definition at line 139 of file DynamixelAX12FtdiDriver.h.
| DynamixelAX12FtdiDriver::DynamixelAX12FtdiDriver | ( | ) |
Constructor Initializes handle but doesn't open channel yet.
Definition at line 27 of file DynamixelAX12FtdiDriver.cpp.
|
virtual |
Destructor Closes connection and destroys device object.
Definition at line 57 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Check if the current trajectory is terminated.
Non blocking.
| flag | is a pointer to return value ("and" of all joints) |
Implements yarp::dev::IPositionControl.
Definition at line 455 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Check if the current trajectory is terminated.
Non blocking.
| joints | array of joint numbers |
| flag | logical "and" of all set of joints |
Implements yarp::dev::IPositionControl.
Definition at line 923 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Check if the current trajectory is terminated.
Non blocking.
| j | is the axis number |
| flag | is a pointer to return value |
Implements yarp::dev::IPositionControl.
Definition at line 446 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Close device Closes the device and shuts down connection.
Reimplemented from yarp::dev::DeviceDriver.
Definition at line 182 of file DynamixelAX12FtdiDriver.cpp.
| bool DynamixelAX12FtdiDriver::configure | ( | yarp::os::Searchable & | config | ) |
Configure device online Configures parts of the device that can be configures online.
| config | Config file containing string pairs for parameters |
Definition at line 202 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::disableTorquePid | ( | int | j | ) |
Definition at line 716 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::enableTorquePid | ( | int | j | ) |
Definition at line 721 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Interfaces methods.
Implements yarp::dev::IPositionControl.
Definition at line 394 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::getBemfParam | ( | int | j, |
| double * | bemf | ||
| ) |
Definition at line 731 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Get the angle of servo.
Implements yarp::dev::IEncoders.
Definition at line 773 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Read the instantaneous acceleration of an axis.
| j | axis number |
| spds | pointer to the array that will contain the output |
Implements yarp::dev::IEncoders.
Definition at line 850 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Read the instantaneous acceleration of all axes.
| accs | pointer to the array that will contain the output |
Implements yarp::dev::IEncoders.
Definition at line 854 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Read the position of all axes.
| encs | pointer to the array that will contain the output |
Implements yarp::dev::IEncoders.
Definition at line 803 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Read the istantaneous speed of an axis.
| j | axis number |
| sp | pointer to storage for the output |
TODO should be changed. not very accurate, though close
Implements yarp::dev::IEncoders.
Definition at line 813 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Read the instantaneous speed of all axes.
| spds | pointer to storage for the output values |
Implements yarp::dev::IEncoders.
Definition at line 840 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Get a subset of motor parameters (bemf, ktau etc) useful for torque control.
| j | joint number |
| params | a struct containing the motor parameters to be retrieved |
Implements yarp::dev::ITorqueControl.
Definition at line 1006 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Get the reference value of the torque for a given joint.
This is NOT the feedback (see getTorque instead).
| j | joint number |
| t | the returned reference torque of joint j |
Implements yarp::dev::ITorqueControl.
Definition at line 579 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Get the reference value of the torque for all joints.
This is NOT the feedback (see getTorques instead).
| t | pointer to the array of torque values |
Implements yarp::dev::ITorqueControl.
Definition at line 571 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Get the last position reference for the specified axis.
This is the dual of PositionMove and shall return only values sent using IPositionControl interface. If other interfaces like IPositionDirect are implemented by the device, this call must ignore their values, i.e. this call must never return a reference sent using IPositionDirect::SetPosition
| ref | last reference sent using PositionMove functions |
Implements yarp::dev::IPositionControl.
Definition at line 986 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Get the last position reference for the specified group of axes.
This is the dual of PositionMove and shall return only values sent using IPositionControl interface. If other interfaces like IPositionDirect are implemented by the device, this call must ignore their values, i.e. this call must never return a reference sent using IPositionDirect::SetPosition
| ref | last reference sent using PositionMove functions |
Implements yarp::dev::IPositionControl.
Definition at line 996 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Get the last position reference for all axes.
This is the dual of PositionMove and shall return only values sent using IPositionControl interface. If other interfaces like IPositionDirect are implemented by the device, this call must ignore their values, i.e. this call must never return a reference sent using IPositionDirect::SetPosition
| ref | last reference sent using PositionMove functions |
Implements yarp::dev::IPositionControl.
Definition at line 991 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Get the value of the torque on a given joint (this is the feedback if you have a torque sensor).
| j | joint number |
| t | pointer to the result value |
Implements yarp::dev::ITorqueControl.
Definition at line 621 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::getTorqueError | ( | int | j, |
| double * | err | ||
| ) |
Definition at line 671 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::getTorqueErrorLimit | ( | int | j, |
| double * | limit | ||
| ) |
Definition at line 701 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::getTorqueErrorLimits | ( | double * | limits | ) |
Definition at line 706 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::getTorqueErrors | ( | double * | errs | ) |
Definition at line 676 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::getTorquePid | ( | int | j, |
| Pid * | pid | ||
| ) |
Definition at line 691 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::getTorquePidOutput | ( | int | j, |
| double * | out | ||
| ) |
Definition at line 681 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::getTorquePidOutputs | ( | double * | outs | ) |
Definition at line 686 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::getTorquePids | ( | Pid * | pids | ) |
Definition at line 696 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Get the full scale of the torque sensor of a given joint.
| j | joint number |
| min | minimum torque of the joint j |
| max | maximum torque of the joint j |
Implements yarp::dev::ITorqueControl.
Definition at line 765 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Get the full scale of the torque sensors of all joints.
| min | pointer to the array that will store minimum torques of the joints |
| max | pointer to the array that will store maximum torques of the joints |
Implements yarp::dev::ITorqueControl.
Definition at line 769 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Get the value of the torque for all joints (this is the feedback if you have torque sensors).
| t | pointer to the array that will store the output |
Implements yarp::dev::ITorqueControl.
Definition at line 646 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
not implemented
Implements yarp::dev::IPositionControl.
Definition at line 522 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Get reference acceleration for a joint.
Returns the acceleration used to generate the trajectory profile.
| joints | pointer to the array of joint numbers |
| accs | pointer to the array that will store the acceleration values |
Implements yarp::dev::IPositionControl.
Definition at line 966 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
not implemented
Implements yarp::dev::IPositionControl.
Definition at line 529 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Get reference speed for a joint.
Returns the speed used to generate the trajectory profile.
| j | joint number |
| ref | pointer to storage for the return value |
Implements yarp::dev::IPositionControl.
Definition at line 507 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Get reference speed of all joints.
These are the values used during the interpolation of the trajectory.
| joints | pointer to the array of joint numbers |
| spds | pointer to the array that will store the speed values. |
Implements yarp::dev::IPositionControl.
Definition at line 956 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Get reference speed of all joints.
These are the values used during the interpolation of the trajectory.
| spds | pointer to the array that will store the speed values. |
Implements yarp::dev::IPositionControl.
Definition at line 512 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Open device Opens and configures the device.
| config | Config file containing string pairs for parameters |
Reimplemented from yarp::dev::DeviceDriver.
Definition at line 66 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
| refs | should be in range [1 300] |
Implements yarp::dev::IPositionControl.
Definition at line 418 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Set new reference point for a subset of joints.
| joints | pointer to the array of joint numbers |
| refs | pointer to the array specifying the new reference points |
Implements yarp::dev::IPositionControl.
Definition at line 903 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Set new reference point for a single axis.
| j | joint number |
| ref | specifies the new ref point |
Implements yarp::dev::IPositionControl.
Definition at line 399 of file DynamixelAX12FtdiDriver.cpp.
Read parameter from motor Requests the value of a parameter from motor.
| id | The id of the device to be contacted |
| param | encodes address in control table and size of parameter (2 Bytes => address + 100, 1 byte => address) |
Definition at line 362 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Set relative position, all joints.
| deltas | pointer to the relative commands |
Implements yarp::dev::IPositionControl.
Definition at line 436 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Set relative position for a subset of joints.
| joints | pointer to the array of joint numbers |
| deltas | pointer to the array of relative commands |
Implements yarp::dev::IPositionControl.
Definition at line 913 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Set relative position.
The command is relative to the current position of the axis.
| j | joint axis number |
| delta | relative command |
Implements yarp::dev::IPositionControl.
Definition at line 427 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Reset encoder, single joint.
Set the encoder value to zero
| j | encoder number |
Implements yarp::dev::IEncoders.
Definition at line 741 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Reset encoders.
Set the encoders value to zero
Implements yarp::dev::IEncoders.
Definition at line 745 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::resetTorquePid | ( | int | j | ) |
Definition at line 711 of file DynamixelAX12FtdiDriver.cpp.
|
virtual |
Send instruction to device Send an instruction to a device of given ID.
The instruction has to be a byte arry containing the AX12 instruction code beginning with the instruction, the address and the parameters. Header and checksum are written automatically.
| id | The hex id of the device to be contacted |
| inst | Byte array containing the instruction body (instruction, address, parameters) |
TODO check if it works with Kaspar. Originally made by Sven. Need testing
Definition at line 220 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::setBemfParam | ( | int | j, |
| double | bemf | ||
| ) |
Definition at line 736 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Set the value of the encoder for a given joint.
| j | encoder number |
| val | new value |
Implements yarp::dev::IEncoders.
Definition at line 749 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Set the value of all encoders.
| vals | pointer to the new values |
Implements yarp::dev::IEncoders.
Definition at line 753 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Set a subset of motor parameters (bemf, ktau etc) useful for torque control.
| j | joint number |
| params | a struct containing the motor parameters to be set |
Implements yarp::dev::ITorqueControl.
Definition at line 1011 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Set the reference value of the torque for a given joint.
| j | joint number |
| t | new value |
Implements yarp::dev::ITorqueControl.
Definition at line 761 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Set the reference value of the torque for all joints.
| t | pointer to the array of torque values |
Implements yarp::dev::ITorqueControl.
Definition at line 757 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Set new torque reference for a subset of joints.
| joints | pointer to the array of joint numbers |
| refs | pointer to the array specifying the new torque reference |
Implements yarp::dev::ITorqueControl.
Definition at line 1001 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::setTorque | ( | int | j, |
| double | t | ||
| ) |
| t | has not real unit. Although it can be roughly estimated based on the maximum toruqe as specified in the document Here t should be only set from 0 - 0x3FF (1023) as int |
Definition at line 598 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::setTorqueErrorLimit | ( | int | j, |
| double | limit | ||
| ) |
Definition at line 661 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::setTorqueErrorLimits | ( | const double * | limits | ) |
Definition at line 666 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::setTorqueOffset | ( | int | j, |
| double | v | ||
| ) |
Definition at line 726 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::setTorquePid | ( | int | j, |
| const Pid & | pid | ||
| ) |
Definition at line 616 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::setTorquePids | ( | const Pid * | pids | ) |
Definition at line 656 of file DynamixelAX12FtdiDriver.cpp.
| ReturnValue DynamixelAX12FtdiDriver::setTorques | ( | const double * | t | ) |
Definition at line 585 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
not implemented
Implements yarp::dev::IPositionControl.
Definition at line 496 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
not implemented
Implements yarp::dev::IPositionControl.
Definition at line 503 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Set reference acceleration on all joints.
This is the value that is used during the generation of the trajectory.
| joints | pointer to the array of joint numbers |
| accs | pointer to the array with acceleration values |
Implements yarp::dev::IPositionControl.
Definition at line 946 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Set reference speed for a joint, this is the speed used during the interpolation of the trajectory.
| j | joint number |
| sp | speed value |
Implements yarp::dev::IPositionControl.
Definition at line 469 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Set reference speed on all joints.
These values are used during the interpolation of the trajectory.
| spds | pointer to the array of speed values. |
Implements yarp::dev::IPositionControl.
Definition at line 484 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Set reference speed on all joints.
These values are used during the interpolation of the trajectory.
| joints | pointer to the array of joint numbers |
| spds | pointer to the array with speed values. |
Implements yarp::dev::IPositionControl.
Definition at line 936 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Stop motion, multiple joints.
Implements yarp::dev::IPositionControl.
Definition at line 537 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Stop motion for subset of joints.
| joints | pointer to the array of joint numbers |
Implements yarp::dev::IPositionControl.
Definition at line 976 of file DynamixelAX12FtdiDriver.cpp.
|
overridevirtual |
Stop motion, single joint.
| j | joint number |
Implements yarp::dev::IPositionControl.
Definition at line 533 of file DynamixelAX12FtdiDriver.cpp.