66 std::string ownerName;
90 "%s: %d msgs av:%.2lf min:%.2lf max:%.2lf [ms]",
362#define LOCKMUTEX std::lock_guard<std::mutex> lg(m_mutex);
367#define CHECK_INTERFACE(VALUE) \
369 if (auto it = m_device_has_interfaces.find(VALUE); \
370 it == m_device_has_interfaces.end() || !it->second) \
372 yCError(CONTROLBOARD_NWC_YARP, \
373 "Device does not implement required interface: %s", \
375 return yarp::dev::ReturnValue::return_code:: \
376 return_value_error_not_implemented_by_device; \
483 std::copy(ret.errs.begin(), ret.errs.end(), errs);
507 std::copy(ret.pids.begin(), ret.pids.end(), pids);
531 std::copy(ret.refs.begin(), ret.refs.end(), refs);
555 std::copy(ret.lims.begin(), ret.lims.end(), limits);
600 enabled = ret.isEnabled;
624 std::copy(ret.outs.begin(), ret.outs.end(), outs);
634 return ReturnValue::return_code::return_value_error_not_ready;
665 return ReturnValue::return_code::return_value_error_not_ready;
734 value = ret.feedforward;
778 std::vector<double>
temp(vals, vals + this->
m_nj);
794 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
805 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
815 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
826 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
836 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
846 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
855 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
864 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
903 std::copy(ret.listOfKeys.begin(), ret.listOfKeys.end(), listOfKeys);
930 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
940 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1052 std::vector<double>
temp(vals, vals + this->
m_nj);
1068 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1079 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1089 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1100 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1109 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1118 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1127 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1136 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1199 std::vector<double>
temp(refs, refs + this->
m_nj);
1228 std::copy(ret.val.begin(), ret.val.end(), refs);
1241 std::copy(ret.val.begin(), ret.val.end(), refs);
1272 std::vector<double>
temp(deltas, deltas + this->
m_nj);
1344 std::vector<double>
temp(spds, spds + this->
m_nj);
1380 std::vector<double>
temp(accs, accs + this->
m_nj);
1410 std::copy(ret.val.begin(), ret.val.end(), spds);
1422 std::copy(ret.val.begin(), ret.val.end(), spds);
1447 std::copy(ret.val.begin(), ret.val.end(), accs);
1459 std::copy(ret.val.begin(), ret.val.end(), accs);
1477 std::vector<int>
tempjoints(joints, joints + len);
1509 message = ret.message;
1522 return ReturnValue::return_code::return_value_error_not_ready;
1530 memcpy(&(
c.body[0]), &v,
sizeof(
double));
1552 return ReturnValue::return_code::return_value_error_not_ready;
1558 c.body.resize(
m_nj);
1566 std::vector<double>
temp(v, v + this->
m_nj);
1610 std::copy(ret.val.begin(), ret.val.end(),
st);
1701 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
1931 std::copy(ret.val.begin(), ret.val.end(), t);
1941 return ReturnValue::return_code::return_value_error_not_ready;
1948 c.body.resize(
m_nj);
1958 std::vector<double>
temp(t, t + this->
m_nj);
1974 return ReturnValue::return_code::return_value_error_not_ready;
2006 return ReturnValue::return_code::return_value_error_not_ready;
2014 for (
int i = 0; i <
n_joint; i++) {
2065 (*params).bemf = ret.params.bemf;
2066 (*params).bemf_scale = ret.params.bemf_scale;
2067 (*params).coulombNeg = ret.params.coulombNeg;
2068 (*params).coulombPos = ret.params.coulombPos;
2069 (*params).ktau = ret.params.ktau;
2070 (*params).ktau_scale = ret.params.ktau_scale;
2071 (*params).velocityThres = ret.params.velocityThres;
2072 (*params).viscousNeg = ret.params.viscousNeg;
2073 (*params).viscousPos = ret.params.viscousPos;
2083 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2092 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2116 std::copy(ret.mins.begin(), ret.mins.end(), min);
2117 std::copy(ret.maxs.begin(), ret.maxs.end(), max);
2133 *stiffness = ret.stiffness;
2134 *damping = ret.damping;
2146 *offset = ret.offset;
2180 *min_stiff = ret.min_stiffness;
2181 *max_stiff = ret.max_stiffness;
2182 *min_damp = ret.min_damping;
2183 *max_damp = ret.max_damping;
2211 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2221 for (
int i = 0; i < modes.size(); i++) {
2229 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2240 for (
int i = 0; i < joints.size(); i++) {
2248 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2294 return ReturnValue::return_code::return_value_error_not_ready;
2302 memcpy(&(
c.body[0]), &ref,
sizeof(
double));
2324 return ReturnValue::return_code::return_value_error_not_ready;
2332 for (
int i = 0; i <
n_joint; i++) {
2360 return ReturnValue::return_code::return_value_error_not_ready;
2366 c.body.resize(
m_nj);
2374 std::vector<double>
temp(refs, refs +
m_nj);
2404 std::copy(ret.val.begin(), ret.val.end(), refs);
2417 std::copy(ret.val.begin(), ret.val.end(), refs);
2431 return ReturnValue::return_code::return_value_error_not_ready;
2439 for (
int i = 0; i <
n_joint; i++) {
2481 std::copy(ret.val.begin(), ret.val.end(),
vels);
2494 std::copy(ret.val.begin(), ret.val.end(),
vels);
2510 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2521 for (
int i = 0; i < joints.size(); i++) {
2529 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2539 for (
int i = 0; i < modes.size(); i++) {
2546 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2696 std::copy(ret.refs.begin(), ret.refs.end(), t);
2718 return ReturnValue::return_code::return_value_error_not_ready;
2724 c.body.resize(
m_nj);
2732 std::vector<double>
temp(refs, refs + this->
m_nj);
2759 return ReturnValue::return_code::return_value_error_not_ready;
2767 for (
int i = 0; i <
n_joint; i++) {
2795 return ReturnValue::return_code::return_value_error_not_ready;
2801 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2811 std::copy(ret.currs.begin(), ret.currs.end(), vals);
2822 return ReturnValue::return_code::return_value_error_not_ready;
2828 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2864 std::copy(ret.mins.begin(), ret.mins.end(), min);
2865 std::copy(ret.maxs.begin(), ret.maxs.end(), max);
2889 return ReturnValue::return_code::return_value_error_not_ready;
2896 c.body.resize(
m_nj);
2906 std::vector<double>
temp(v, v + this->
m_nj);
2936 std::copy(ret.val.begin(), ret.val.end(), refs);
2946 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
2955 return ret?
ReturnValue_ok:ReturnValue::return_code::return_value_error_not_ready;
3002 enabled = ret.enabled;
3026 return ReturnValue::return_code::return_value_error_not_ready;
3032 c.head.addInt32(
jnt);
3056 return ReturnValue::return_code::return_value_error_not_ready;
3062 c.body.resize(
m_nj);
3063 for (
size_t i = 0; i <
vels.size(); i++) {
3087 return ReturnValue::return_code::return_value_error_not_ready;
3093 c.head.addInt32(
jnts.size());
3095 for (
size_t i = 0; i <
jnts.size(); i++) {
3098 c.body.resize(
jnts.size());
3099 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::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::os::PortWriterBuffer< yarp::dev::CommandMessageData > command_buffer
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.
void useCallback(TypedReaderCallback< T > &callback) override
Set an object whose onRead method will be called when data is available.
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...
T & get()
A synonym of PortWriterBuffer::prepare.
void write(bool forceStrict=false)
Try to write the last buffer returned by PortWriterBuffer::get.
void attach(Port &port)
Set the Port to which objects will be written.
bool addOutput(const std::string &name) override
Add an output connection to the specified port.
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.
void resize(size_t size) override
Resize the vector.
T * data()
Return a pointer to the first element of the vector.
#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.