66 std::string ownerName;
90 "%s: %d msgs av:%.2lf min:%.2lf max:%.2lf [ms]",
360#define LOCKMUTEX std::lock_guard<std::mutex> lg(m_mutex);
365#define CHECK_INTERFACE(VALUE) \
367 if (auto it = m_device_has_interfaces.find(VALUE); \
368 it == m_device_has_interfaces.end() || !it->second) \
370 yCError(CONTROLBOARD_NWC_YARP, \
371 "Device does not implement required interface: %s", \
373 return yarp::dev::ReturnValue::return_code:: \
374 return_value_error_not_implemented_by_device; \
481 std::copy(ret.errs.begin(), ret.errs.end(), errs);
505 std::copy(ret.pids.begin(), ret.pids.end(), pids);
529 std::copy(ret.refs.begin(), ret.refs.end(), refs);
553 std::copy(ret.lims.begin(), ret.lims.end(), limits);
598 enabled = ret.isEnabled;
622 std::copy(ret.outs.begin(), ret.outs.end(), outs);
632 return ReturnValue::return_code::return_value_error_not_ready;
663 return ReturnValue::return_code::return_value_error_not_ready;
732 value = ret.feedforward;
776 std::vector<double>
temp(vals, vals + this->
m_nj);
792 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
803 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
813 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
824 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
834 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
844 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
853 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
862 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
901 std::copy(ret.listOfKeys.begin(), ret.listOfKeys.end(), listOfKeys);
928 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
938 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1050 std::vector<double>
temp(vals, vals + this->
m_nj);
1066 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1077 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1087 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1098 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1107 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1116 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1125 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1134 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1197 std::vector<double>
temp(refs, refs + this->
m_nj);
1226 std::copy(ret.val.begin(), ret.val.end(), refs);
1239 std::copy(ret.val.begin(), ret.val.end(), refs);
1270 std::vector<double>
temp(deltas, deltas + this->
m_nj);
1342 std::vector<double>
temp(spds, spds + this->
m_nj);
1378 std::vector<double>
temp(accs, accs + this->
m_nj);
1408 std::copy(ret.val.begin(), ret.val.end(), spds);
1420 std::copy(ret.val.begin(), ret.val.end(), spds);
1445 std::copy(ret.val.begin(), ret.val.end(), accs);
1457 std::copy(ret.val.begin(), ret.val.end(), accs);
1475 std::vector<int>
tempjoints(joints, joints + len);
1507 message = ret.message;
1520 return ReturnValue::return_code::return_value_error_not_ready;
1528 memcpy(&(
c.body[0]), &v,
sizeof(
double));
1550 return ReturnValue::return_code::return_value_error_not_ready;
1556 c.body.resize(
m_nj);
1564 std::vector<double>
temp(v, v + this->
m_nj);
1608 std::copy(ret.val.begin(), ret.val.end(),
st);
1699 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1929 std::copy(ret.val.begin(), ret.val.end(), t);
1939 return ReturnValue::return_code::return_value_error_not_ready;
1946 c.body.resize(
m_nj);
1956 std::vector<double>
temp(t, t + this->
m_nj);
1972 return ReturnValue::return_code::return_value_error_not_ready;
2004 return ReturnValue::return_code::return_value_error_not_ready;
2012 for (
int i = 0; i <
n_joint; i++) {
2063 (*params).bemf = ret.params.bemf;
2064 (*params).bemf_scale = ret.params.bemf_scale;
2065 (*params).coulombNeg = ret.params.coulombNeg;
2066 (*params).coulombPos = ret.params.coulombPos;
2067 (*params).ktau = ret.params.ktau;
2068 (*params).ktau_scale = ret.params.ktau_scale;
2069 (*params).velocityThres = ret.params.velocityThres;
2070 (*params).viscousNeg = ret.params.viscousNeg;
2071 (*params).viscousPos = ret.params.viscousPos;
2081 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2090 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2114 std::copy(ret.mins.begin(), ret.mins.end(), min);
2115 std::copy(ret.maxs.begin(), ret.maxs.end(), max);
2131 *stiffness = ret.stiffness;
2132 *damping = ret.damping;
2144 *offset = ret.offset;
2178 *min_stiff = ret.min_stiffness;
2179 *max_stiff = ret.max_stiffness;
2180 *min_damp = ret.min_damping;
2181 *max_damp = ret.max_damping;
2209 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2219 for (
int i = 0; i < modes.size(); i++) {
2227 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2238 for (
int i = 0; i < joints.size(); i++) {
2246 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2292 return ReturnValue::return_code::return_value_error_not_ready;
2300 memcpy(&(
c.body[0]), &ref,
sizeof(
double));
2322 return ReturnValue::return_code::return_value_error_not_ready;
2330 for (
int i = 0; i <
n_joint; i++) {
2358 return ReturnValue::return_code::return_value_error_not_ready;
2364 c.body.resize(
m_nj);
2372 std::vector<double>
temp(refs, refs +
m_nj);
2402 std::copy(ret.val.begin(), ret.val.end(), refs);
2415 std::copy(ret.val.begin(), ret.val.end(), refs);
2429 return ReturnValue::return_code::return_value_error_not_ready;
2437 for (
int i = 0; i <
n_joint; i++) {
2479 std::copy(ret.val.begin(), ret.val.end(),
vels);
2492 std::copy(ret.val.begin(), ret.val.end(),
vels);
2508 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2519 for (
int i = 0; i < joints.size(); i++) {
2527 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2537 for (
int i = 0; i < modes.size(); i++) {
2544 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2694 std::copy(ret.refs.begin(), ret.refs.end(), t);
2716 return ReturnValue::return_code::return_value_error_not_ready;
2722 c.body.resize(
m_nj);
2730 std::vector<double>
temp(refs, refs + this->
m_nj);
2757 return ReturnValue::return_code::return_value_error_not_ready;
2765 for (
int i = 0; i <
n_joint; i++) {
2793 return ReturnValue::return_code::return_value_error_not_ready;
2799 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2809 std::copy(ret.currs.begin(), ret.currs.end(), vals);
2820 return ReturnValue::return_code::return_value_error_not_ready;
2826 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2862 std::copy(ret.mins.begin(), ret.mins.end(), min);
2863 std::copy(ret.maxs.begin(), ret.maxs.end(), max);
2887 return ReturnValue::return_code::return_value_error_not_ready;
2894 c.body.resize(
m_nj);
2904 std::vector<double>
temp(v, v + this->
m_nj);
2934 std::copy(ret.val.begin(), ret.val.end(), refs);
2944 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2953 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
3000 enabled = ret.enabled;
3024 return ReturnValue::return_code::return_value_error_not_ready;
3030 c.head.addInt32(
jnt);
3054 return ReturnValue::return_code::return_value_error_not_ready;
3060 c.body.resize(
m_nj);
3061 for (
size_t i = 0; i <
vels.size(); i++) {
3085 return ReturnValue::return_code::return_value_error_not_ready;
3091 c.head.addInt32(
jnts.size());
3093 for (
size_t i = 0; i <
jnts.size(); i++) {
3096 c.body.resize(
jnts.size());
3097 for (
size_t i = 0; i <
jnts.size(); i++) {
define control board standard interfaces
constexpr yarp::conf::vocab32_t VOCAB_TIMESTAMP
#define CHECK_INTERFACE(VALUE)
const yarp::os::LogComponent & CONTROLBOARD_NWC_YARP()
constexpr yarp::conf::vocab32_t VOCAB_AMP_CURRENT
constexpr yarp::conf::vocab32_t VOCAB_AMP_CURRENTS
constexpr yarp::conf::vocab32_t VOCAB_CM_CONTROL_MODES
constexpr yarp::conf::vocab32_t VOCAB_CM_CONTROL_MODE
constexpr yarp::conf::vocab32_t VOCAB_CURRENT_REF_GROUP
constexpr yarp::conf::vocab32_t VOCAB_CURRENT_REFS
constexpr yarp::conf::vocab32_t VOCAB_CURRENTCONTROL_INTERFACE
constexpr yarp::conf::vocab32_t VOCAB_ENCODER_ACCELERATIONS
constexpr yarp::conf::vocab32_t VOCAB_ENCODER
constexpr yarp::conf::vocab32_t VOCAB_ENCODER_SPEEDS
constexpr yarp::conf::vocab32_t VOCAB_ENCODER_SPEED
constexpr yarp::conf::vocab32_t VOCAB_ENCODER_ACCELERATION
constexpr yarp::conf::vocab32_t VOCAB_ENCODERS
constexpr yarp::conf::vocab32_t VOCAB_INTERACTION_MODES
constexpr yarp::conf::vocab32_t VOCAB_INTERACTION_MODE
constexpr yarp::conf::vocab32_t VOCAB_MOTOR_ENCODER_SPEED
constexpr yarp::conf::vocab32_t VOCAB_MOTOR_ENCODER_ACCELERATION
constexpr yarp::conf::vocab32_t VOCAB_MOTOR_ENCODER
constexpr yarp::conf::vocab32_t VOCAB_MOTOR_ENCODER_SPEEDS
constexpr yarp::conf::vocab32_t VOCAB_MOTOR_ENCODERS
constexpr yarp::conf::vocab32_t VOCAB_TEMPERATURE
constexpr yarp::conf::vocab32_t VOCAB_PWMCONTROL_INTERFACE
constexpr yarp::conf::vocab32_t VOCAB_PWMCONTROL_PWM_OUTPUTS
constexpr yarp::conf::vocab32_t VOCAB_PWMCONTROL_REF_PWMS
constexpr yarp::conf::vocab32_t VOCAB_PWMCONTROL_PWM_OUTPUT
constexpr yarp::conf::vocab32_t VOCAB_PIDCONTROL_SET_FEEDFORWARD
constexpr yarp::conf::vocab32_t VOCAB_PIDCONTROL_INTERFACE
constexpr yarp::conf::vocab32_t VOCAB_PIDCONTROL_SET_OFFSET
constexpr yarp::conf::vocab32_t VOCAB_POSITIONDIRECTCONTROL_INTERFACE
constexpr yarp::conf::vocab32_t VOCAB_POSITION_DIRECTS
constexpr yarp::conf::vocab32_t VOCAB_POSITION_DIRECT
constexpr yarp::conf::vocab32_t VOCAB_POSITION_DIRECT_GROUP
constexpr yarp::conf::vocab32_t VOCAB_TRQ
constexpr yarp::conf::vocab32_t VOCAB_TORQUES_DIRECTS
constexpr yarp::conf::vocab32_t VOCAB_TRQS
constexpr yarp::conf::vocab32_t VOCAB_TORQUES_DIRECT_GROUP
constexpr yarp::conf::vocab32_t VOCAB_TORQUES_DIRECT
constexpr yarp::conf::vocab32_t VOCAB_TORQUECONTROL_INTERFACE
constexpr yarp::conf::vocab32_t VOCAB_VELOCITY_MOVE
constexpr yarp::conf::vocab32_t VOCAB_VELOCITYCONTROL_INTERFACE
constexpr yarp::conf::vocab32_t VOCAB_VELOCITY_MOVE_GROUP
constexpr yarp::conf::vocab32_t VOCAB_VELOCITY_MOVES
constexpr yarp::conf::vocab32_t VOCAB_VELOCITY_DIRECT_SET_ONE
constexpr yarp::conf::vocab32_t VOCAB_VELOCITYDIRECTCONTROL_INTERFACE
constexpr yarp::conf::vocab32_t VOCAB_VELOCITY_DIRECT_SET_GROUP
constexpr yarp::conf::vocab32_t VOCAB_VELOCITY_DIRECT_SET_ALL
virtual return_getTargetVelocityOne getTargetVelocityOneRPC(const std::int32_t j) const
virtual return_getCurrentImpedanceLimit getCurrentImpedanceLimitRPC(const std::int32_t j) const
virtual return_getTargetPositionGroup getTargetPositionGroupRPC(const std::vector< std::int32_t > &joints) const
virtual yarp::dev::ReturnValue setPeakCurrentRPC(const std::int32_t m, const double val)
virtual return_getRefTorqueAll getRefTorqueAllRPC() const
virtual yarp::dev::ReturnValue resetMotorEncoderRPC(const std::int32_t j)
virtual yarp::dev::ReturnValue setRefCurrentOneRPC(const std::int32_t j, const double ref)
virtual return_checkMotionDoneOne checkMotionDoneOneRPC(const std::int32_t j) const
virtual yarp::dev::ReturnValue setMotorEncoderCountsPerRevolutionRPC(const std::int32_t j, const double val)
virtual return_getPidExtraInfo getPidExtraInfoRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::int16_t j) const
virtual yarp::dev::ReturnValue setRefCurrentGroupRPC(const std::vector< std::int32_t > &j, const std::vector< double > &refs)
virtual yarp::dev::ReturnValue calibrateSingleJointRPC(const std::int32_t j)
virtual return_getDeviceInterfaces getDeviceInterfacesRPC() const
virtual return_getPidOutputs getPidOutputsRPC(const yarp::dev::PidControlTypeEnum pidtype) const
virtual yarp::dev::ReturnValue calibrationDoneRPC(const std::int32_t j)
virtual yarp::dev::ReturnValue setControlModeGroupRPC(const std::vector< std::int32_t > &j, const std::vector< yarp::dev::SelectableControlModeEnum > &modes)
virtual return_isCalibratorDevicePresent isCalibratorDevicePresentRPC() const
virtual yarp::dev::ReturnValue setManualBrakeActiveRPC(const std::int32_t j, const bool active)
virtual yarp::dev::ReturnValue setTrajSpeedAllRPC(const std::vector< double > &spds)
virtual yarp::dev::ReturnValue setPWMLimitRPC(const std::int32_t m, const double val)
virtual yarp::dev::ReturnValue setInteractionModeOneRPC(const std::int32_t axis, const yarp::dev::InteractionModeEnum mode)
virtual yarp::dev::ReturnValue relativeMoveAllRPC(const std::vector< double > &deltas)
virtual return_getPid getPidRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::int16_t j) const
virtual yarp::dev::ReturnValue velocityMoveAllRPC(const std::vector< double > &refs)
virtual return_getPowerSupplyVoltage getPowerSupplyVoltageRPC(const std::int32_t m) const
virtual yarp::dev::ReturnValue setPosLimitsRPC(const std::int16_t j, const double min, const double max)
virtual return_getRefDutyCycleAll getRefDutyCycleAllRPC() const
virtual return_getNumberOfMotors getNumberOfMotorsRPC() const
virtual yarp::dev::ReturnValue stopAllRPC()
virtual bool checkProtocolVersion()
virtual yarp::dev::ReturnValue parkWholePartRPC()
virtual yarp::dev::ReturnValue setRefPositionGroupRPC(const std::vector< std::int32_t > &j, const std::vector< double > &value)
virtual yarp::dev::ReturnValue homingSingleJointRPC(const std::int32_t j)
virtual yarp::dev::ReturnValue disablePidRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::int16_t j)
virtual yarp::dev::ReturnValue setTrajAccelerationOneRPC(const std::int32_t j, const double acc)
virtual return_getMotorTorqueParams getMotorTorqueParamsRPC(const std::int32_t j)
virtual return_getTargetVelocityAll getTargetVelocityAllRPC() const
virtual return_getPidReferences getPidReferencesRPC(const yarp::dev::PidControlTypeEnum pidtype) const
virtual return_getVelLimits getVelLimitsRPC(const std::int16_t j) const
virtual return_getTrajAccelerationOne getTrajAccelerationOneRPC(const std::int32_t j) const
virtual return_getAmpStatusAll getAmpStatusAllRPC() const
virtual yarp::dev::ReturnValue setMotorTorqueParamsRPC(const std::int32_t j, const yMotorTorqueParameters ¶ms)
virtual return_getTorqueRangeAll getTorqueRangeAllRPC() const
virtual return_getCurrentAll getCurrentAllRPC() const
virtual return_getTrajSpeedsAll getTrajSpeedsAllRPC() const
virtual return_getMaxCurrent getMaxCurrentRPC(const std::int32_t j) const
virtual yarp::dev::ReturnValue setControlModeOneRPC(const std::int32_t j, const yarp::dev::SelectableControlModeEnum mod)
virtual yarp::dev::ReturnValue setPidErrorLimitsRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::vector< double > &limits)
virtual yarp::dev::ReturnValue setPidRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::int16_t j, const yarp::dev::Pid &pid)
virtual return_getAvailableControlModes getAvailableControlModesRPC(const std::int16_t j) const
virtual yarp::dev::ReturnValue stopOneRPC(const std::int32_t j)
virtual return_getPWMLimit getPWMLimitRPC(const std::int32_t m) const
virtual return_isPidEnabled isPidEnabledRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::int16_t j) const
virtual yarp::dev::ReturnValue parkSingleJointRPC(const std::int32_t j, const bool wait)
virtual return_getMotorEncoderCountsPerRevolution getMotorEncoderCountsPerRevolutionRPC(const std::int32_t m) const
virtual yarp::dev::ReturnValue disableAmpRPC(const std::int32_t j)
virtual yarp::dev::ReturnValue setEncoderOneRPC(const std::int32_t j, const double val)
virtual yarp::dev::ReturnValue calibrateRobotRPC()
virtual return_getTargetVelocityGroup getTargetVelocityGroupRPC(const std::vector< std::int32_t > &joints) const
virtual yarp::dev::ReturnValue setPidFeedforwardOneRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::int16_t j, const double off)
virtual yarp::dev::ReturnValue setRefDutyCycleOneRPC(const std::int32_t j, const double v)
virtual return_getTargetPositionAll getTargetPositionAllRPC() const
virtual return_getRemoteVariable getRemoteVariableRPC(const std::string &key) const
virtual yarp::dev::ReturnValue resetPidRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::int16_t j)
virtual return_getTrajSpeedOne getTrajSpeedOneRPC(const std::int32_t j) const
virtual yarp::dev::ReturnValue setRefVelocityAllRPC(const std::vector< double > &ref)
virtual yarp::dev::ReturnValue resetEncoderOneRPC(const std::int32_t j)
virtual return_getRefTorqueOne getRefTorqueOneRPC(const std::int32_t j) const
virtual yarp::dev::ReturnValue setEncoderAllRPC(const std::vector< double > &vals)
virtual yarp::dev::ReturnValue setMotorEncodersAllRPC(const std::vector< double > &vals)
virtual return_checkMotionDoneGroup checkMotionDoneGroupRPC(const std::vector< std::int32_t > &joints) const
virtual yarp::dev::ReturnValue setTrajAccelerationsGroupRPC(const std::vector< std::int32_t > &joints, const std::vector< double > &accs)
virtual yarp::dev::ReturnValue setRefPositionOneRPC(const std::int32_t j, const double value)
virtual yarp::dev::ReturnValue setTemperatureLimitRPC(const std::int32_t m, const double val)
virtual yarp::dev::ReturnValue setRefTorqueGroupRPC(const std::vector< std::int32_t > &j, const std::vector< double > &val)
virtual yarp::dev::ReturnValue setPidReferenceRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::int16_t j, const double ref)
virtual yarp::dev::ReturnValue setNominalCurrentRPC(const std::int32_t m, const double val)
virtual yarp::dev::ReturnValue resetEncoderAllRPC()
virtual yarp::dev::ReturnValue setRefTorqueOneRPC(const std::int32_t j, const double val)
virtual yarp::dev::ReturnValue resetMotorEncodersRPC()
virtual return_getCurrentRangeOne getCurrentRangeOneRPC(const std::int32_t j) const
virtual return_getImpedanceOffset getImpedanceOffsetRPC(const std::int32_t j) const
virtual return_getPidOffset getPidOffsetRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::int16_t j) const
virtual return_getGearboxRatio getGearboxRatioRPC(const std::int32_t m) const
virtual yarp::dev::ReturnValue setMaxCurrentRPC(const std::int32_t j, const double v)
virtual return_getRefPositionAll getRefPositionAllRPC() const
virtual yarp::dev::ReturnValue setAutoBrakeEnabledRPC(const std::int32_t j, const bool enabled)
virtual yarp::dev::ReturnValue quitCalibrateRPC()
virtual return_getAxes getAxesRPC() const
virtual yarp::dev::ReturnValue parkRPC(const bool wait)
virtual return_getAutoBrakeEnabled getAutoBrakeEnabledRPC(const std::int32_t j) const
virtual return_getNominalCurrent getNominalCurrentRPC(const std::int32_t m) const
virtual yarp::dev::ReturnValue positionMoveOneRPC(const std::int32_t j, const double ref)
virtual yarp::dev::ReturnValue quitParkRPC()
virtual yarp::dev::ReturnValue setPidReferencesRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::vector< double > &refs)
virtual yarp::dev::ReturnValue enablePidRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::int16_t j)
virtual yarp::dev::ReturnValue setGearboxRatioRPC(const std::int32_t m, const double val)
virtual return_getTrajSpeedsGroup getTrajSpeedsGroupRPC(const std::vector< std::int32_t > &joints) const
virtual yarp::dev::ReturnValue relativeMoveOneRPC(const std::int32_t j, const double delta)
virtual return_getRefPositionOne getRefPositionOneRPC(const std::int32_t j) const
virtual yarp::dev::ReturnValue calibrateWholePartRPC()
virtual return_getPidExtraInfos getPidExtraInfosRPC(const yarp::dev::PidControlTypeEnum pidtype) const
virtual return_getPeakCurrent getPeakCurrentRPC(const std::int32_t m) const
virtual yarp::dev::ReturnValue setImpedanceRPC(const std::int32_t j, const double stiffness, const double damping)
virtual return_getRefVelocityOne getRefVelocityOneRPC(const std::int32_t j) const
virtual yarp::dev::ReturnValue calibrateAxisWithParamsRPC(const std::int32_t j, const std::int32_t ui, const double v1, const double v2, const double v3)
virtual yarp::dev::ReturnValue setRefTorqueAllRPC(const std::vector< double > &val)
virtual yarp::dev::ReturnValue setTrajAccelerationsAllRPC(const std::vector< double > &accs)
virtual yarp::dev::ReturnValue setImpedanceOffsetRPC(const std::int32_t j, const double offset)
virtual yarp::dev::ReturnValue setVelLimitsRPC(const std::int16_t j, const double min, const double max)
virtual yarp::dev::ReturnValue setInteractionModesGroupRPC(const std::vector< std::int32_t > &joints, const std::vector< yarp::dev::InteractionModeEnum > &modes)
virtual yarp::dev::ReturnValue stopGroupRPC(const std::vector< std::int32_t > &joints)
virtual yarp::dev::ReturnValue setRefCurrentAllRPC(const std::vector< double > &refs)
virtual return_getAmpStatusOne getAmpStatusOneRPC(const std::int32_t j) const
virtual yarp::dev::ReturnValue homingWholePartRPC()
virtual yarp::dev::ReturnValue positionMoveGroupRPC(const std::vector< std::int32_t > &joints, const std::vector< double > &refs)
virtual yarp::dev::ReturnValue setTrajSpeedOneRPC(const std::int32_t j, const double sp)
virtual return_getImpedance getImpedanceRPC(const std::int32_t j) const
virtual return_getTargetPositionOne getTargetPositionOneRPC(const std::int32_t j) const
virtual return_getPidReference getPidReferenceRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::int16_t j) const
virtual return_getTorqueRangeOne getTorqueRangeOneRPC(const std::int32_t j) const
virtual return_getPidErrorLimits getPidErrorLimitsRPC(const yarp::dev::PidControlTypeEnum pidtype) const
virtual return_getPidError getPidErrorRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::int16_t j) const
virtual return_getRefVelocityAll getRefVelocityAllRPC() const
virtual return_getJointType getJointTypeRPC(const std::int32_t j)
virtual return_getCurrentOne getCurrentOneRPC(const std::int32_t j) const
virtual return_getRefDutyCycleOne getRefDutyCycleOneRPC(const std::int32_t j) const
virtual yarp::dev::ReturnValue setRefVelocityOneRPC(const std::int32_t j, const double ref)
virtual yarp::dev::ReturnValue setTrajSpeedGroupRPC(const std::vector< std::int32_t > &joints, const std::vector< double > &spds)
virtual return_checkMotionDoneAll checkMotionDoneAllRPC() const
virtual yarp::dev::ReturnValue velocityMoveOneRPC(const std::int32_t j, const double ref)
virtual yarp::dev::ReturnValue setRemoteVariableRPC(const std::string &key, const yarp::os::Bottle &val)
virtual return_getCurrentRangeAll getCurrentRangeAllRPC() const
virtual yarp::dev::ReturnValue setRefVelocityGroupRPC(const std::vector< std::int32_t > &j, const std::vector< double > &ref)
virtual yarp::dev::ReturnValue setCalibrationParametersRPC(const std::int32_t j, const yCalibrationParameters ¶ms)
virtual return_getRemoteVariablesList getRemoteVariablesListRPC() const
virtual return_getPosLimits getPosLimitsRPC(const std::int16_t j) const
virtual return_getPidErrors getPidErrorsRPC(const yarp::dev::PidControlTypeEnum pidtype) const
virtual return_getPidOutput getPidOutputRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::int16_t j) const
virtual return_getRefCurrentOne getRefCurrentOneRPC(const std::int32_t j) const
virtual yarp::dev::ReturnValue enableAmpRPC(const std::int32_t j)
virtual yarp::dev::ReturnValue setControlModeAllRPC(const std::vector< yarp::dev::SelectableControlModeEnum > &modes)
virtual yarp::dev::ReturnValue relativeMoveGroupRPC(const std::vector< std::int32_t > &joints, const std::vector< double > &refs)
virtual return_getPidFeedforward getPidFeedforwardRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::int16_t j) const
virtual return_getAxisName getAxisNameRPC(const std::int32_t j)
virtual yarp::dev::ReturnValue abortCalibrationRPC()
virtual yarp::dev::ReturnValue setRefDutyCycleAllRPC(const std::vector< double > &v)
virtual yarp::dev::ReturnValue setPidsRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::vector< yarp::dev::Pid > &pids)
virtual yarp::dev::ReturnValue abortParkRPC()
virtual return_getPids getPidsRPC(const yarp::dev::PidControlTypeEnum pidtype) const
virtual yarp::dev::ReturnValue velocityMoveGroupRPC(const std::vector< std::int32_t > &joints, const std::vector< double > &refs)
virtual return_isJointBraked isJointBrakedRPC(const std::int32_t j) const
virtual return_getAvailablePids getAvailablePidsRPC(const std::int16_t j) const
virtual return_getTemperatureLimit getTemperatureLimitRPC(const std::int32_t m) const
virtual return_getRefCurrentAll getRefCurrentAllRPC() const
virtual yarp::dev::ReturnValue positionMoveAllRPC(const std::vector< double > &refs)
virtual return_getRefVelocityGroup getRefVelocityGroupRPC(const std::vector< std::int32_t > &j) const
virtual yarp::dev::ReturnValue setPidOffsetOneRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::int16_t j, const double off)
virtual return_getPidErrorLimit getPidErrorLimitRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::int16_t j) const
virtual return_getTrajAccelerationAll getTrajAccelerationAllRPC() const
virtual return_getRefPositionGroup getRefPositionGroupRPC(const std::vector< std::int32_t > &j) const
virtual yarp::dev::ReturnValue setRefPositionAllRPC(const std::vector< double > &value)
virtual return_getNumberOfMotorEncoders getNumberOfMotorEncodersRPC() const
virtual return_getLastJointFault getLastJointFaultRPC(const std::int32_t j) const
virtual return_getTrajAccelerationGroup getTrajAccelerationGroupRPC(const std::vector< std::int32_t > &joints) const
virtual yarp::dev::ReturnValue setPidErrorLimitRPC(const yarp::dev::PidControlTypeEnum pidtype, const std::int16_t j, const double limit)
virtual yarp::dev::ReturnValue setInteractionModesAllRPC(const std::vector< yarp::dev::InteractionModeEnum > &modes)
virtual yarp::dev::ReturnValue setMotorEncoderRPC(const std::int32_t j, const double val)
std::string m_local_qos_packet_priority
std::string m_carrier_cmd
std::string m_writeStrict
std::string m_remote_qos_packet_priority
int m_remote_qos_thread_priority
int m_local_qos_thread_priority
bool parseParams(const yarp::os::Searchable &config) override
Parse the DeviceDriver parameters.
int m_local_qos_thread_policy
int m_remote_qos_thread_policy
yarp::dev::ReturnValue setCalibrationParameters(int j, const CalibrationParameters ¶ms) override
Start calibration, this method is very often platform specific.
yarp::dev::ReturnValue setPid(const PidControlTypeEnum &pidtype, int j, const Pid &pid) override
Set new PID value for a joint axis.
yarp::dev::ReturnValue setImpedanceOffset(int j, double offset) override
Set current force Offset for a specific joint.
yarp::dev::ReturnValue calibrateWholePart() override
calibrateWholePart: call the procedure for calibrating the whole device
yarp::dev::ReturnValue setImpedance(int j, double stiffness, double damping) override
Set current impedance gains (stiffness,damping) for a specific joint.
StateExtendedInputPort extendedIntputStatePort
yarp::dev::ReturnValue getTrajAccelerations(const int n_joint, const int *joints, double *accs) override
Get reference acceleration for a joint.
yarp::dev::ReturnValue getPidErrorLimits(const PidControlTypeEnum &pidtype, double *limits) override
Get the error limit for all controllers.
yarp::dev::ReturnValue setRefDutyCycles(const double *v) override
Sets the reference dutycycle for all the motors.
yarp::dev::ReturnValue stop() override
Stop motion, multiple joints.
yarp::dev::ReturnValue getRemoteVariablesList(yarp::os::Bottle *listOfKeys) override
yarp::dev::ReturnValue getPidError(const PidControlTypeEnum &pidtype, int j, double *err) override
Get the current error for a joint.
yarp::dev::ReturnValue getAmpStatus(int *st) override
yarp::dev::ReturnValue setPidErrorLimit(const PidControlTypeEnum &pidtype, int j, double limit) override
Set the error limit for the controller on a specific joint.
yarp::dev::ReturnValue parkWholePart() override
parkWholePart: start the parking procedure for the whole part
yarp::dev::ReturnValue setTrajAccelerations(const int n_joint, const int *joints, const double *accs) override
Set reference acceleration on all joints.
yarp::dev::ReturnValue getEncoderAccelerations(double *accs) override
Read the instantaneous acceleration of all axes.
yarp::dev::ReturnValue getCurrent(int j, double *val) override
yarp::dev::ReturnValue setGearboxRatio(int m, const double val) override
Set the gearbox ratio for a specific motor.
yarp::dev::ReturnValue getRefTorques(double *t) override
Get the reference value of the torque for all joints.
yarp::dev::ReturnValue setTrajAcceleration(int j, double acc) override
Set reference acceleration for a joint.
yarp::dev::ReturnValue setPidFeedforward(const PidControlTypeEnum &pidtype, int j, double v) override
Set the feedforward value for the specified PID controller.
bool close() override
Close the device driver and stop the port connections.
yarp::dev::ReturnValue resetMotorEncoders() override
Reset motor encoders.
yarp::dev::ReturnValue getTorqueRanges(double *min, double *max) override
Get the full scale of the torque sensors of all joints.
yarp::dev::ReturnValue setPidErrorLimits(const PidControlTypeEnum &pidtype, const double *limits) override
Get the error limit for the controller on all joints.
yarp::dev::ReturnValue getMotorEncoderCountsPerRevolution(int m, double *cpr) override
Gets number of counts per revolution for motor encoder m.
bool writeStrict_singleJoint
yarp::dev::ReturnValue calibrationDone(int j) override
Check if the calibration is terminated, on a particular joint.
yarp::dev::ReturnValue getRefPositions(double *refs) override
Get the last position reference for all axes.
yarp::dev::ReturnValue checkMotionDone(int j, bool &flag) override
Check if the current trajectory is terminated.
DiagnosticThread * diagnosticThread
yarp::dev::ReturnValue setPidReferences(const PidControlTypeEnum &pidtype, const double *refs) override
Set the controller reference, multiple axes.
yarp::dev::ReturnValue getMotorEncoder(int j, double *v) override
Read the value of a motor encoder.
yarp::dev::ReturnValue setPids(const PidControlTypeEnum &pidtype, const Pid *pids) override
Set new PID value on multiple axes.
yarp::dev::JointStateData last_wholePart
yarp::dev::ReturnValue resetEncoders() override
Reset encoders.
yarp::dev::ReturnValue getControlMode(int j, yarp::dev::ControlModeEnum &mode) override
Get the current control mode.
yarp::dev::ReturnValue getTorqueRange(int j, double *min, double *max) override
Get the full scale of the torque sensor of a given joint.
yarp::dev::ReturnValue getAvailablePids(int j, std::vector< yarp::dev::PidControlTypeEnum > &avail) override
Return a list of available pid types mode for the given joint.
yarp::dev::ReturnValue getImpedanceOffset(int j, double *offset) override
Get current force Offset for a specific joint.
yarp::dev::ReturnValue getTemperatures(double *vals) override
Get temperature of all the motors.
yarp::dev::ReturnValue getTargetPosition(const int joint, double *ref) override
Get the last position reference for the specified axis.
yarp::dev::ReturnValue disablePid(const PidControlTypeEnum &pidtype, int j) override
Disable the PID computation for a joint.
yarp::dev::ReturnValue getTorques(double *t) override
Get the value of the torque for all joints (this is the feedback if you have torque sensors).
yarp::dev::ReturnValue setAutoBrakeEnabled(int j, bool enabled) override
Enables/Disables the automatic joint brake.
yarp::dev::ReturnValue getMotorEncoderSpeeds(double *spds) override
Read the instantaneous speed of all motor encoders.
yarp::dev::ReturnValue getPidFeedforward(const PidControlTypeEnum &pidtype, int j, double &v) override
Get the currently set feedforward value for the specified PID controller.
yarp::dev::ReturnValue isCalibratorDevicePresent(bool *isCalib) override
isCalibratorDevicePresent: check if a calibrator device has been set
yarp::dev::ReturnValue setPositions(const int n_joint, const int *joints, const double *refs) override
Set new reference point for all axes.
yarp::dev::ReturnValue getRefCurrent(int j, double *t) override
Get the reference value of the current for a single motor.
yarp::dev::ReturnValue getInteractionMode(int axis, yarp::dev::InteractionModeEnum &mode) override
Get the current interaction mode of the robot, values can be stiff or compliant.
yarp::dev::ReturnValue enableAmp(int j) override
Enable the amplifier on a specific joint.
yarp::dev::ReturnValue getGearboxRatio(int m, double *val) override
Get the gearbox ratio for a specific motor.
yarp::dev::ReturnValue getMotorEncoderAcceleration(int j, double *acc) override
Read the instantaneous acceleration of a motor encoder.
yarp::dev::ReturnValue getCurrentRange(int j, double *min, double *max) override
Get the full scale of the current measurement for a given motor (e.g.
yarp::dev::ReturnValue getRefPosition(const int joint, double *ref) override
Get the last position reference for the specified axis.
yarp::dev::ReturnValue getPidReference(const PidControlTypeEnum &pidtype, int j, double *ref) override
Get the current reference of the PID controller for a specific joint.
yarp::os::BufferedPort< yarp::dev::CommandMessageData > command_p
yarp::dev::ReturnValue setInteractionModes(const std::vector< int > &joints, const std::vector< yarp::dev::InteractionModeEnum > &modes) override
Set the interaction mode of the robot for a set of joints, values can be stiff or compliant.
yarp::dev::ReturnValue getControlModes(const std::vector< int > &joints, std::vector< yarp::dev::ControlModeEnum > &modes) override
Get the current control mode for a subset of axes.
yarp::dev::ReturnValue getAxes(size_t &ax) override
Get the number of controlled axes.
yarp::dev::ReturnValue setInteractionMode(int axis, yarp::dev::InteractionModeEnum mode) override
Set the interaction mode of the robot, values can be stiff or compliant.
yarp::dev::ReturnValue getDutyCycles(double *outs) override
Gets the current dutycycle of the output of the amplifier (i.e.
yarp::dev::ReturnValue getAvailableControlModes(int j, std::vector< yarp::dev::SelectableControlModeEnum > &avail) override
Return a list of available control mode for the given joint.
yarp::dev::ReturnValue getPids(const PidControlTypeEnum &pidtype, Pid *pids) override
Get current PID value for a specific joint.
yarp::dev::ReturnValue getEncoderAcceleration(int j, double *acc) override
Read the instantaneous acceleration of an axis.
yarp::dev::ReturnValue abortPark() override
yarp::dev::ReturnValue quitCalibrate() override
quitCalibrate: interrupt the calibration procedure
yarp::dev::ReturnValue disableAmp(int j) override
Disable the amplifier on a specific joint.
yarp::dev::ReturnValue getMaxCurrent(int j, double *v) override
Returns the maximum electric current allowed for a given motor.
yarp::dev::ReturnValue getDutyCycle(int j, double *out) override
Gets the current dutycycle of the output of the amplifier (i.e.
yarp::dev::ReturnValue homingWholePart() override
homingWholePart: call the homing procedure for a the whole part/device
yarp::dev::ReturnValue getRefCurrents(double *t) override
Get the reference value of the currents for all motors.
yarp::dev::ReturnValue setMaxCurrent(int j, double v) override
yarp::dev::ReturnValue positionMove(int j, double ref) override
Set new reference point for a single axis.
yarp::dev::ReturnValue setMotorEncoderCountsPerRevolution(int m, const double cpr) override
Sets number of counts per revolution for motor encoder m.
yarp::dev::ReturnValue setRefTorques(const double *t) override
Set the reference value of the torque for all joints.
yarp::dev::ReturnValue getEncoderSpeed(int j, double *sp) override
Read the istantaneous speed of an axis.
std::map< std::string, bool > m_device_has_interfaces
yarp::dev::ReturnValue getRemoteVariable(std::string key, yarp::os::Bottle &val) override
yarp::dev::ReturnValue getAutoBrakeEnabled(int j, bool &enabled) const override
checks if the automatic joint brake mode is enabled or disabled.
yarp::dev::ReturnValue setMotorTorqueParams(int j, const MotorTorqueParameters params) override
Set a subset of motor parameters (bemf, ktau etc) useful for torque control.
yarp::dev::ReturnValue setPeakCurrent(int m, const double val) override
yarp::dev::ReturnValue setPosLimits(int axis, double min, double max) override
Set the software limits for a particular axis, the behavior of the control card when these limits are...
yarp::dev::ReturnValue getPWM(int m, double *val) override
yarp::dev::ReturnValue setRefDutyCycle(int j, double v) override
Sets the reference dutycycle to a single motor.
yarp::dev::ReturnValue getPidExtraInfo(const PidControlTypeEnum &pidtype, int j, PidExtraInfo &info) override
Get PID extra info and measurement units for a specific joint.
yarp::dev::ReturnValue getTemperatureLimit(int m, double *val) override
Retrieves the current temperature limit for a specific motor.
yarp::dev::ReturnValue enablePid(const PidControlTypeEnum &pidtype, int j) override
Enable the PID computation for a joint.
yarp::dev::ReturnValue setTrajSpeeds(const int n_joint, const int *joints, const double *spds) override
Set reference speed on all joints.
yarp::dev::ReturnValue velocityMove(int j, double v) override
Start motion at a given speed, single joint.
yarp::dev::ReturnValue getNumberOfMotors(int *num) override
Get the number of available motors.
yarp::dev::ReturnValue getCurrents(double *vals) override
yarp::dev::ReturnValue getPWMLimit(int m, double *val) override
bool writeStrict_moreJoints
yarp::dev::ReturnValue getEncoders(double *encs) override
Read the position of all axes.
yarp::dev::ReturnValue getEncoderSpeeds(double *spds) override
Read the instantaneous speed of all axes.
yarp::dev::ReturnValue getTrajSpeed(int j, double *ref) override
Get reference speed for a joint.
yarp::dev::ReturnValue getMotorTorqueParams(int j, MotorTorqueParameters *params) override
Get a subset of motor parameters (bemf, ktau etc) useful for torque control.
yarp::dev::ReturnValue getMotorEncoderTimed(int j, double *v, double *t) override
Read the instantaneous position of a motor encoder.
yarp::dev::ReturnValue getJointType(int j, yarp::dev::JointTypeEnum &type) override
yarp::dev::ReturnValue getRefDutyCycles(double *refs) override
Gets the last reference sent using the setRefDutyCycles function.
std::mutex extendedPortMutex
yarp::dev::ReturnValue getLastJointFault(int j, int &fault, std::string &message) override
yarp::dev::ReturnValue getPidErrorLimit(const PidControlTypeEnum &pidtype, int j, double *limit) override
Get the error limit for the controller on a specific joint.
yarp::dev::ReturnValue getTrajSpeeds(const int n_joint, const int *joints, double *spds) override
Get reference speed of all joints.
yarp::dev::ReturnValue getMotorEncoderAccelerations(double *accs) override
Read the instantaneous acceleration of all motor encoders.
yarp::dev::ReturnValue calibrateSingleJoint(int j) override
calibrateSingleJoint: call the calibration procedure for the single joint
yarp::dev::ReturnValue getPidOffset(const PidControlTypeEnum &pidtype, int j, double &v) override
Get the currently set offset value for the specified PID controller.
yarp::dev::ReturnValue setControlModes(const std::vector< int > &joints, const std::vector< yarp::dev::SelectableControlModeEnum > &modes) override
Set the current control mode for a subset of axes.
yarp::dev::ReturnValue getImpedance(int j, double *stiffness, double *damping) override
Get current impedance gains (stiffness,damping,offset) for a specific joint.
yarp::dev::ReturnValue setRefTorque(int j, double v) override
Set the reference value of the torque for a given joint.
yarp::dev::ReturnValue parkSingleJoint(int j, bool _wait=true) override
parkSingleJoint(): start the parking procedure for the single joint
yarp::dev::ReturnValue setPWMLimit(int m, const double val) override
bool open(Searchable &config) override
Open the DeviceDriver.
yarp::dev::ReturnValue getPidExtraInfos(const PidControlTypeEnum &pidtype, std::vector< PidExtraInfo > &info) override
Get PID extra info and measurement units for a specific joint.
yarp::dev::ReturnValue getPid(const PidControlTypeEnum &pidtype, int j, Pid *pid) override
Get current PID value for a specific joint.
yarp::dev::ReturnValue setNominalCurrent(int m, const double val) override
yarp::dev::ReturnValue getRefTorque(int j, double *t) override
Get the reference value of the torque for a given joint.
yarp::dev::ReturnValue setManualBrakeActive(int j, bool active) override
Enables/Disables manually the joint brake.
yarp::dev::ReturnValue getNumberOfMotorEncoders(int *num) override
Get the number of available motor encoders.
yarp::dev::ReturnValue abortCalibration() override
yarp::dev::ReturnValue homingSingleJoint(int j) override
homingSingleJoint: call the homing procedure for a single joint
yarp::dev::ReturnValue park(bool wait=true) override
yarp::dev::ReturnValue getAxisName(int j, std::string &name) override
yarp::dev::ReturnValue setPidReference(const PidControlTypeEnum &pidtype, int j, double ref) override
Set the controller reference for a given axis.
yarp::dev::ReturnValue resetEncoder(int j) override
Reset encoder, single joint.
yarp::dev::ReturnValue setControlMode(int j, yarp::dev::SelectableControlModeEnum mode) override
Set the current control mode.
yarp::dev::ReturnValue setPidOffset(const PidControlTypeEnum &pidtype, int j, double v) override
Set an offset value for a given controller.
yarp::dev::ReturnValue getPosLimits(int axis, double *min, double *max) override
Get the software limits for a particular axis.
yarp::dev::ReturnValue setVelLimits(int axis, double min, double max) override
Set the software speed limits for a particular axis, the behavior of the control card when these limi...
yarp::dev::ReturnValue resetMotorEncoder(int j) override
Reset motor encoder, single motor.
yarp::dev::ReturnValue getMotorEncoderSpeed(int j, double *sp) override
Read the instantaneous speed of a motor encoder.
yarp::dev::ReturnValue isPidEnabled(const PidControlTypeEnum &pidtype, int j, bool &enabled) override
Get the current status (enabled/disabled) of the PID.
yarp::dev::ReturnValue getCurrentRanges(double *min, double *max) override
Get the full scale of the current measurements for all motors motor (e.g.
yarp::dev::ReturnValue isJointBraked(int j, bool &braked) const override
Check is the joint brake is currently active.
yarp::dev::ReturnValue getTargetVelocity(const int joint, double *vel) override
Get the last reference speed set by velocityMove for single joint.
yarp::dev::ReturnValue setRefCurrents(const double *refs) override
Set the reference value of the currents for all motors.
yarp::dev::ReturnValue getMotorEncoders(double *encs) override
Read the position of all motor encoders.
yarp::dev::ReturnValue getRefDutyCycle(int j, double *ref) override
Gets the last reference sent using the setRefDutyCycle function.
yarp::dev::ReturnValue getInteractionModes(const std::vector< int > &joints, std::vector< yarp::dev::InteractionModeEnum > &modes) override
Get the current interaction mode of the robot for a set of joints, values can be stiff or compliant.
yarp::dev::ReturnValue setTrajSpeed(int j, double sp) override
Set reference speed for a joint, this is the speed used during the interpolation of the trajectory.
yarp::dev::ReturnValue getEncodersTimed(double *encs, double *ts) override
Read the instantaneous acceleration of all axes.
yarp::dev::ReturnValue setMotorEncoders(const double *vals) override
Set the value of all motor encoders.
yarp::dev::ReturnValue setEncoders(const double *vals) override
Set the value of all encoders.
yarp::dev::ReturnValue getVelLimits(int axis, double *min, double *max) override
Get the software speed limits for a particular axis.
yarp::dev::ReturnValue getTargetVelocities(double *vels) override
Get the last reference speed set by velocityMove for all joints.
yarp::dev::ReturnValue setRefVelocity(int jnt, double vel) override
Set the velocity of single joint.
yarp::dev::ReturnValue getPidOutputs(const PidControlTypeEnum &pidtype, double *outs) override
Get the output of the controllers (e.g.
yarp::dev::ReturnValue getRefVelocity(const int jnt, double &vel) override
Get the last reference velocity set by setRefVelocity() for a single joint.
yarp::dev::ReturnValue calibrateAxisWithParams(int j, unsigned int ui, double v1, double v2, double v3) override
Start calibration, this method is very often platform specific.
yarp::dev::ReturnValue quitPark() override
quitPark: interrupt the park procedure
yarp::dev::ReturnValue calibrateRobot() override
Calibrate robot by using an external calibrator.
yarp::dev::ReturnValue setRefCurrent(int j, double ref) override
Set the reference value of the current for a single motor.
yarp::dev::ReturnValue getEncoder(int j, double *v) override
Read the value of an encoder.
yarp::dev::ReturnValue getPeakCurrent(int m, double *val) override
yarp::dev::ReturnValue getTargetPositions(double *refs) override
Get the last position reference for all axes.
yarp::dev::JointStateData last_singleJoint
yarp::dev::ReturnValue getTrajAcceleration(int j, double *acc) override
Get reference acceleration for a joint.
yarp::dev::ReturnValue relativeMove(int j, double delta) override
Set relative position.
yarp::dev::ReturnValue resetPid(const PidControlTypeEnum &pidtype, int j) override
Reset the controller of a given joint, usually sets the current status of the joint as the reference ...
yarp::dev::ReturnValue setMotorEncoder(int j, const double val) override
Set the value of the motor encoder for a given motor.
yarp::dev::ReturnValue getEncoderTimed(int j, double *v, double *t) override
Read the instantaneous acceleration of all axes.
yarp::dev::ReturnValue getCurrentImpedanceLimit(int j, double *min_stiff, double *max_stiff, double *min_damp, double *max_damp) override
Get the current impedance limits for a specific joint.
yarp::dev::ReturnValue setEncoder(int j, double val) override
Set the value of the encoder for a given joint.
Stamp getLastInputStamp() override
Get the time stamp for the last read data.
yarp::dev::ReturnValue getPowerSupplyVoltage(int m, double *val) override
yarp::dev::ReturnValue getPidOutput(const PidControlTypeEnum &pidtype, int j, double *out) override
Get the output of the controller (e.g.
yarp::dev::ReturnValue getTorque(int j, double *t) override
Get the value of the torque on a given joint (this is the feedback if you have a torque sensor).
yarp::dev::ReturnValue setRemoteVariable(std::string key, const yarp::os::Bottle &val) override
yarp::dev::ReturnValue setPosition(int j, double ref) override
Set new position for a single axis.
yarp::dev::ReturnValue getPidErrors(const PidControlTypeEnum &pidtype, double *errs) override
Get the error of all joints.
yarp::dev::ReturnValue setTemperatureLimit(int m, const double val) override
Set the temperature limit for a specific motor.
yarp::dev::ReturnValue getTemperature(int m, double *val) override
Get temperature of a motor.
yarp::dev::ReturnValue getMotorEncodersTimed(double *encs, double *ts) override
Read the instantaneous position of all motor encoders.
yarp::dev::ReturnValue getNominalCurrent(int m, double *val) override
yarp::dev::ReturnValue getPidReferences(const PidControlTypeEnum &pidtype, double *refs) override
Get the current reference of all PID controllers.
void run() override
Loop function.
void setOwner(StateExtendedInputPort *o)
yarp::sig::VectorOf< float > pwmDutycycle
yarp::sig::VectorOf< int > controlMode
yarp::sig::VectorOf< int > interactionMode
yarp::sig::VectorOf< double > motorAcceleration
yarp::sig::VectorOf< double > jointPosition
yarp::sig::VectorOf< double > torque
yarp::sig::VectorOf< double > motorVelocity
yarp::sig::VectorOf< double > jointVelocity
yarp::sig::VectorOf< double > current
yarp::sig::VectorOf< double > jointAcceleration
yarp::sig::VectorOf< double > motorPosition
Contains the parameters for a PID.
A simple collection of objects that can be described and transmitted in a portable way.
Value & get(size_type index) const
Reads a Value v from a certain part of the list.
A mini-server for performing network communication in the background.
std::string getName() const override
Get name of port.
void close() override
Stop port activity.
bool open(const std::string &name) override
Start port operation, with a specific name, with automatically-chosen network parameters.
void interrupt() override
Interrupt any current reads or writes attached to the port.
bool addOutput(const std::string &name) override
Add an output connection to the specified port.
void useCallback(TypedReaderCallback< T > &callback) override
Set an object whose onRead method will be called when data is available.
void write(bool forceStrict=false)
Write the current object being returned by BufferedPort::prepare.
T & prepare()
Access the object which will be transmitted by the next call to yarp::os::BufferedPort::write.
static bool setConnectionQos(const std::string &src, const std::string &dest, const QosStyle &srcStyle, const QosStyle &destStyle, bool quiet=true)
Adjust the Qos preferences of a connection.
An abstraction for a periodic thread.
PeriodicThread(double period, ShouldUseSystemClock useSystemClock=ShouldUseSystemClock::No, PeriodicThreadClock clockAccuracy=PeriodicThreadClock::Relative)
Constructor.
bool start()
Call this to start the thread.
void stop()
Call this to stop the thread, this call blocks until the thread is terminated (and releaseThread() ca...
void interrupt() override
Interrupt any current reads or writes attached to the port.
void close() override
Stop port activity.
bool open(const std::string &name) override
Start port operation, with a specific name, with automatically-chosen network parameters.
Preferences for the port's Quality of Service.
A base class for nested structures that can be searched.
An abstraction for a time stamp and/or sequence number.
double getTime() const
Get the time stamp.
virtual yarp::conf::float64_t asFloat64() const
Get 64-bit floating point value.
virtual yarp::conf::vocab32_t asVocab32() const
Get 32 bit vocabulary identifier as an integer.
virtual std::int32_t asInt32() const
Get 32-bit integer value.
bool attachAsClient(yarp::os::UnbufferedContactable &port)
Tag this WireLink as a client, sending data via the specified port.
yarp::os::WireLink & yarp()
Get YARP state associated with this object.
#define yCInfo(component,...)
#define yCError(component,...)
#define yCDebug(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.