21 _subDevVerbose =
false;
102 if ((
iTorque==
nullptr) && (_subDevVerbose))
107 if ((
iImpedance==
nullptr) && (_subDevVerbose))
112 if ((
iInteract==
nullptr) && (_subDevVerbose))
117 if ((
iMotEnc==
nullptr) && (_subDevVerbose))
122 if ((
imotor==
nullptr) && (_subDevVerbose))
127 if ((
iVar ==
nullptr) && (_subDevVerbose))
132 if ((
info ==
nullptr) && (_subDevVerbose))
137 if ((
iPwm ==
nullptr) && (_subDevVerbose))
142 if ((
iCurr ==
nullptr) && (_subDevVerbose))
147 if ((
iFault ==
nullptr) && (_subDevVerbose))
152 if ((
iBrake ==
nullptr) && (_subDevVerbose)) {
156 if ((
iVelDir ==
nullptr) && (_subDevVerbose))
196 else if(
info!=
nullptr)
249 int off=(
int)remappedControlBoards.
lut[j].axisIndexInSubControlBoard;
250 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
281 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
296 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
311 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
326 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
341 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
356 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
389 size_t subIndex=remappedControlBoards.
lut[j].subControlBoardIndex;
421 for(
int j=0; j < n_joints; j++)
423 size_t subIndex=remappedControlBoards.
lut[joints[j]].subControlBoardIndex;
435 this->createListOfJointsDecomposition(n_joints,joints,remappedControlBoards);
442 for(
int j=0; j < n_joints; j++)
444 size_t subIndex=remappedControlBoards.
lut[joints[j]].subControlBoardIndex;
460 for(
int j=0; j < n_joints; j++)
462 size_t subIndex=remappedControlBoards.
lut[joints[j]].subControlBoardIndex;
474 this->createListOfJointsDecomposition(n_joints,joints,remappedControlBoards);
481 for(
int j=0; j < n_joints; j++)
483 size_t subIndex=remappedControlBoards.
lut[joints[j]].subControlBoardIndex;
499 for(
int j=0; j < n_joints; j++)
501 size_t subIndex=remappedControlBoards.
lut[joints[j]].subControlBoardIndex;
513 this->createListOfJointsDecomposition(n_joints,joints,remappedControlBoards);
520 for(
int j=0; j < n_joints; j++)
522 size_t subIndex=remappedControlBoards.
lut[joints[j]].subControlBoardIndex;
528void ControlBoardArbitraryAxesDecomposition::createListOfJointsDecomposition(
const int n_joints,
const int* joints,
const RemappedControlBoards & remappedControlBoards)
537 for(
int j=0; j < n_joints; j++)
539 int off=(
int)remappedControlBoards.
lut[joints[j]].axisIndexInSubControlBoard;
540 size_t subIndex=remappedControlBoards.
lut[joints[j]].subControlBoardIndex;
551 createListOfJointsDecomposition(n_joints,joints,remappedControlBoards);
const yarp::os::LogComponent & CONTROLBOARDREMAPPER()
bool configure(const RemappedControlBoards &remappedControlBoards)
Resize the buffers using the information in the RemappedControlBoards.
std::vector< std::vector< double > > m_bufferForSubControlBoard
std::vector< std::vector< yarp::dev::SelectableControlModeEnum > > m_bufferForSubControlBoardSelectableControlModesEnum
std::vector< std::vector< yarp::dev::InteractionModeEnum > > m_bufferForSubControlBoardInteractionModes
std::vector< std::vector< yarp::dev::ControlModeEnum > > m_bufferForSubControlBoardControlModesEnum
void fillSubControlBoardBuffersFromArbitraryJointVector(const double *arbitraryVec, const int n_joints, const int *joints, const RemappedControlBoards &remappedControlBoards)
Fill buffers for the SubControlBoard from a vector of joints of the RemappedControlBoards.
std::vector< std::vector< int > > m_jointsInSubControlBoard
void resizeSubControlBoardBuffers(const int n_joints, const int *joints, const RemappedControlBoards &remappedControlBoards)
Resize buffers to have the dimension of specified by the method (used for multi joint methods that re...
std::vector< int > m_counterForControlBoard
void fillArbitraryJointVectorFromSubControlBoardBuffers(double *arbitraryVec, const int n_joints, const int *joints, const RemappedControlBoards &remappedControlBoards)
Fill a vector of joints of the ControlBoardRemapper from the buffers of the SubControlBoard .
std::vector< int > m_nJointsInSubControlBoard
std::vector< int > m_nJointsInSubControlBoard
bool configure(const RemappedControlBoards &remappedControlBoards)
Resize the buffers using the information in the RemappedControlBoards.
std::vector< int > m_counterForControlBoard
std::vector< std::vector< int > > m_jointsInSubControlBoard
int m_nrOfControlledAxesInRemappedCtrlBrd
void fillCompleteJointVectorFromSubControlBoardBuffers(double *full, const RemappedControlBoards &remappedControlBoards)
Fill a vector of joints of the ControlBoardRemapper from the buffers of the SubControlBoard .
void fillSubControlBoardBuffersFromCompleteJointVector(const double *full, const RemappedControlBoards &remappedControlBoards)
Fill buffers for the SubControlBoard from a vector of joints of the RemappedControlBoards.
std::vector< std::vector< double > > m_bufferForSubControlBoard
std::vector< std::vector< yarp::dev::ControlModeEnum > > m_bufferForSubControlBoardControlModesEnum
std::vector< std::vector< yarp::dev::SelectableControlModeEnum > > m_bufferForSubControlBoardSelectableControlModesEnum
std::vector< std::vector< yarp::dev::InteractionModeEnum > > m_bufferForSubControlBoardInteractionModes
size_t getNrOfSubControlBoards() const
std::vector< RemappedAxis > lut
Vector of dimension getNrOfRemappedAxes .
size_t getNrOfRemappedAxes() const
yarp::dev::IPositionControl * pos
yarp::dev::IImpedanceControl * iImpedance
RemappedSubControlBoard()
yarp::dev::IAmplifierControl * amp
yarp::dev::IEncodersTimed * iJntEnc
yarp::dev::IInteractionMode * iInteract
yarp::dev::IRemoteVariables * iVar
yarp::dev::ICurrentControl * iCurr
yarp::dev::ITorqueControl * iTorque
yarp::dev::IVelocityControl * vel
yarp::dev::IControlMode * iMode
yarp::dev::IJointFault * iFault
yarp::dev::IVelocityDirect * iVelDir
yarp::dev::IPositionDirect * posDir
yarp::dev::IRemoteCalibrator * remcalib
bool attach(yarp::dev::PolyDriver *d, const std::string &id)
yarp::dev::IPidControl * pid
yarp::dev::IAxisInfo * info
yarp::dev::IControlLimits * lim
yarp::dev::IMotor * imotor
yarp::dev::IJointBrake * iBrake
yarp::dev::IPWMControl * iPwm
yarp::dev::IControlCalibration * calib
yarp::dev::PolyDriver * subdevice
yarp::dev::IMotorEncoders * iMotEnc
yarp::dev::IPreciselyTimed * iTimed
bool view(T *&x)
Get an interface to the device driver.
virtual yarp::dev::ReturnValue getAxes(size_t &ax)=0
Get the number of controlled axes.
virtual yarp::dev::ReturnValue getAxes(size_t &ax)=0
Get the number of controlled axes.
A container for a device driver.
bool isValid() const
Check if device is valid.
A mini-server for performing network communication in the background.
#define yCError(component,...)
#define yCAssert(component, x)
#define yCWarning(component,...)
For streams capable of holding different kinds of content, check what they actually have.
SelectableControlModeEnum
An interface to the operating system, including Port based communication.