YARP
Yet Another Robot Platform
 
Loading...
Searching...
No Matches
FakeMotionControl.h
Go to the documentation of this file.
1/*
2 * SPDX-FileCopyrightText: 2006-2021 Istituto Italiano di Tecnologia (IIT)
3 * SPDX-License-Identifier: BSD-3-Clause
4 */
5
6#ifndef YARP_DEVICE_FAKE_MOTIONCONTROL
7#define YARP_DEVICE_FAKE_MOTIONCONTROL
8
9#include <yarp/os/Time.h>
10#include <yarp/os/Bottle.h>
11#include <yarp/sig/Vector.h>
12#include <yarp/os/PeriodicThread.h>
13#include <yarp/dev/DeviceDriver.h>
14#include <yarp/dev/ControlBoardInterfaces.h>
15#include <yarp/dev/ControlBoardInterfacesImpl.h>
16#include <yarp/dev/IVirtualAnalogSensor.h>
17#include <yarp/dev/ImplementVirtualAnalogSensor.h>
18#include <yarp/dev/ImplementPositionControl.h>
19#include <yarp/dev/ImplementVelocityControl.h>
20#include <yarp/dev/ImplementJointFault.h>
21#include <yarp/dev/ImplementJointBrake.h>
22
23#include <mutex>
24#include "FakeMotionControl_ParamsParser.h"
25
26struct ImpedanceLimits
27{
28 double min_stiff;
29 double max_stiff;
30 double min_damp;
31 double max_damp;
32 double param_a;
33 double param_b;
34 double param_c;
35
36public:
37 ImpedanceLimits()
38 {
39 min_stiff=0;
40 max_stiff=0;
41 min_damp=0;
42 max_damp=0;
43 param_a=0;
44 param_b=0;
45 param_c=0;
46 }
47
48 double get_min_stiff()
49 {
50 return min_stiff;
51 }
52 double get_max_stiff()
53 {
54 return max_stiff;
55 }
56 double get_min_damp()
57 {
58 return min_damp;
59 }
60 double get_max_damp()
61 {
62 return max_damp;
63 }
64};
65
73
87class FakeMotionControl :
88 public FakeMotionControl_ParamsParser,
89 public yarp::dev::DeviceDriver,
90 public yarp::os::PeriodicThread,
91 public yarp::dev::IPidControlRaw,
92 public yarp::dev::IControlCalibrationRaw,
93 public yarp::dev::IAmplifierControlRaw,
94 public yarp::dev::IEncodersTimedRaw,
95 public yarp::dev::IMotorEncodersRaw,
96 public yarp::dev::IMotorRaw,
97 public yarp::dev::IPositionControlRaw,
98 public yarp::dev::IVelocityControlRaw,
99 public yarp::dev::IVelocityDirectRaw,
100 public yarp::dev::IControlModeRaw,
101 public yarp::dev::IControlLimitsRaw,
102 public yarp::dev::IPositionDirectRaw,
103 public yarp::dev::ITorqueControlRaw,
104 public yarp::dev::ICurrentControlRaw,
105 public yarp::dev::IPWMControlRaw,
106 public yarp::dev::IImpedanceControlRaw,
107 public yarp::dev::IInteractionModeRaw,
108 public yarp::dev::IAxisInfoRaw,
109 public yarp::dev::IVirtualAnalogSensorRaw, //*
110 public yarp::dev::IJointBrakeRaw,
111 public yarp::dev::IJointFaultRaw,
112 public yarp::dev::ImplementControlCalibration,
113 public yarp::dev::ImplementAmplifierControl,
114 public yarp::dev::ImplementPidControl,
115 public yarp::dev::ImplementEncodersTimed,
116 public yarp::dev::ImplementPositionControl,
117 public yarp::dev::ImplementVelocityControl,
118 public yarp::dev::ImplementVelocityDirect,
119 public yarp::dev::ImplementControlMode,
120 public yarp::dev::ImplementImpedanceControl,
121 public yarp::dev::ImplementJointBrake,
122 public yarp::dev::ImplementJointFault,
123 public yarp::dev::ImplementMotorEncoders,
124 public yarp::dev::ImplementTorqueControl,
125 public yarp::dev::ImplementControlLimits,
126 public yarp::dev::ImplementPositionDirect,
127 public yarp::dev::ImplementInteractionMode,
128 public yarp::dev::ImplementCurrentControl,
129 public yarp::dev::ImplementPWMControl,
130 public yarp::dev::ImplementMotor,
131 public yarp::dev::ImplementAxisInfo,
132 public yarp::dev::ImplementVirtualAnalogSensor //*
133{
134private:
135 enum VerboseLevel
136 {
137 MUTE = 0, // only errors that prevent device from working
138 QUIET = 1, // adds errors that can cause malfunctioning
139 DEFAULT = 2, // adds warnings // DEFAULT // show noisy messages about back-compatible changes
140 CHATTY = 3, // adds info messages
141 VERBOSE = 4, // adds debug messages
142 VERY_VERBOSE = 5, // adds trace of events (shows thread running and catch if they get stuck)
143 VERY_VERY_VERBOSE = 6 // adds messages printed every cycle, so too much verbose for usage, only for deep debugging
144 };
145
146 std::recursive_mutex _mutex;
147 double _cycleTimestamp;
148 int _njoints;
149 int *_axisMap= nullptr;
150 double* _angleToEncoder = nullptr;
151 double* _encodersStamp = nullptr;
152 double* _ampsToSensor = nullptr;
153 double* _dutycycleToPWM = nullptr;
154 float* _DEPRECATED_encoderconversionfactor = nullptr;
155 float* _DEPRECATED_encoderconversionoffset = nullptr;
156// uint8_t *_jointEncoderType; /** joint encoder type*/
157 int* _jointEncoderRes = nullptr;
158 int* _rotorEncoderRes = nullptr;
159 // uint8_t *_rotorEncoderType= nullptr; /** rotor encoder type*/
160 double* _gearbox = nullptr;
161 bool* _hasHallSensor = nullptr;
162 bool* _hasTempSensor = nullptr;
163 bool* _hasRotorEncoder = nullptr;
164 bool* _hasRotorEncoderIndex = nullptr;
165 int* _rotorIndexOffset = nullptr;
166 int* _motorPoles = nullptr;
167 double* _rotorlimits_max = nullptr;
168 double* _rotorlimits_min = nullptr;
169 yarp::dev::Pid *_ppids= nullptr;
170 yarp::dev::Pid *_tpids= nullptr;
171 yarp::dev::Pid *_cpids= nullptr;
172 yarp::dev::Pid *_vpids= nullptr;
173 bool *_ppids_ena= nullptr;
174 bool *_tpids_ena= nullptr;
175 bool *_cpids_ena= nullptr;
176 bool *_vpids_ena= nullptr;
177 double *_ppids_lim= nullptr;
178 double *_tpids_lim= nullptr;
179 double *_cpids_lim= nullptr;
180 double *_vpids_lim= nullptr;
181 double *_ppids_ref= nullptr;
182 double *_tpids_ref= nullptr;
183 double *_cpids_ref= nullptr;
184 double *_vpids_ref= nullptr;
185
186 std::string* _axisName = nullptr;
187 yarp::dev::JointTypeEnum* _jointType = nullptr;
188// ImpedanceLimits *_impedance_limits= nullptr; /** impedance limits */
189 double* _limitsMin = nullptr;
190 double* _limitsMax = nullptr;
191 double* _kinematic_mj = nullptr;
192 //double *_currentLimits= nullptr; /** current limits */
193// MotorCurrentLimits *_currentLimits= nullptr;
194 double* _maxJntCmdVelocity = nullptr;
195 double* _maxMotorVelocity = nullptr;
196 int* _velocityShifts = nullptr;
197 int* _velocityTimeout = nullptr;
198 double* _kbemf = nullptr;
199 double* _ktau = nullptr;
200 int* _kbemf_scale = nullptr;
201 int* _ktau_scale = nullptr;
202 double* _viscousPos = nullptr;
203 double* _viscousNeg = nullptr;
204 double* _coulombPos = nullptr;
205 double* _coulombNeg = nullptr;
206 double* _velocityThres = nullptr;
207 int* _filterType = nullptr;
208 int* _torqueSensorId = nullptr;
209 int* _torqueSensorChan = nullptr;
210 double* _maxTorque = nullptr;
211 double* _newtonsToSensor = nullptr;
212 bool* checking_motiondone = nullptr; /* flag telling if I'm already waiting for motion done */
213 double* _last_position_move_time = nullptr;
214 double* _motorPwmLimits = nullptr;
215 double* _torques = nullptr;
216 bool* _braked= nullptr;
217 bool* _autobraked= nullptr;
218
219// ImpedanceParameters *_impedance_params; /** impedance parameters */
220
221 bool verbosewhenok;
222 bool useRawEncoderData;
223 bool _pwmIsLimited;
224 bool _torqueControlEnabled;
226 enum torqueControlUnitsType {T_MACHINE_UNITS=0, T_METRIC_UNITS=1};
227 torqueControlUnitsType _torqueControlUnits;
228
229 enum positionControlUnitsType {P_MACHINE_UNITS=0, P_METRIC_UNITS=1};
230 positionControlUnitsType _positionControlUnits;
231
232 // internal stuff
233 bool velocity_watchdog_enabled = false; //false for testing purposes. On the real robot is true.
234 bool openloop_watchdog_enabled = false; //false for testing purposes. On the real robot is true.
235 int *_controlModes = nullptr;
236 int *_hwfault_code = nullptr;
237 std::string *_hwfault_message = nullptr;
238 int *_interactMode = nullptr;
239 bool *_enabledAmp = nullptr; // Middle step toward a full enabled motor controller. Amp (pwm) plus Pid enable command must be sent in order to get the joint into an active state.
240 bool *_enabledPid = nullptr; // Depends on enabledAmp. When both are set, the joint exits the idle mode and goes into position mode. If one of them is disabled, it falls to idle.
241 bool *_calibrated = nullptr; // Flag to know if the calibrate function has been called for the joint
242 double *_posCtrl_references = nullptr; // used for position control.
243 double *_posDir_references = nullptr; // used for position Direct control.
244 double *_ref_speeds = nullptr; // used for position control.
245 double *_command_speeds = nullptr; // used for velocity control.
246 double *_dir_vel_commands = nullptr; // used for direct velocity control.
247 double *_ref_accs = nullptr; // for velocity control, in position min jerk eq is used.
248 double *_ref_torques = nullptr; // for torque control.
249 double *_ref_currents = nullptr;
250 yarp::sig::Vector current, nominalCurrent, maxCurrent, peakCurrent;
251 yarp::sig::Vector pwm, pwmLimit, refpwm, supplyVoltage,last_velocity_command, last_pwm_command;
252 yarp::sig::Vector pos, dpos, vel, speed, acc, loc, amp;
253 double prev_time;
254 bool opened;
255
256 // debugging
257 VerboseLevel verbose;
258public:
259
260 FakeMotionControl();
261 ~FakeMotionControl();
262
263 // Device Driver
264 bool open(yarp::os::Searchable &par) override;
265 bool close() override;
266 bool fromConfig(yarp::os::Searchable &config);
267
268 virtual bool initialised();
269
273 bool alloc(int njoints);
274
278 void resizeBuffers();
279
280 bool threadInit() override;
281 void threadRelease() override;
282
284 bool setPidRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j, const yarp::dev::Pid &pid) override;
285 bool setPidsRaw(const yarp::dev::PidControlTypeEnum& pidtype,const yarp::dev::Pid *pids) override;
286 bool setPidReferenceRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j, double ref) override;
287 bool setPidReferencesRaw(const yarp::dev::PidControlTypeEnum& pidtype,const double *refs) override;
288 bool setPidErrorLimitRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j, double limit) override;
289 bool setPidErrorLimitsRaw(const yarp::dev::PidControlTypeEnum& pidtype,const double *limits) override;
290 bool getPidErrorRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j, double *err) override;
291 bool getPidErrorsRaw(const yarp::dev::PidControlTypeEnum& pidtype, double *errs) override;
292 bool getPidOutputRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j, double *out) override;
293 bool getPidOutputsRaw(const yarp::dev::PidControlTypeEnum& pidtype,double *outs) override;
294 bool getPidRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j, yarp::dev::Pid *pid) override;
295 bool getPidsRaw(const yarp::dev::PidControlTypeEnum& pidtype, yarp::dev::Pid *pids) override;
296 bool getPidReferenceRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j, double *ref) override;
297 bool getPidReferencesRaw(const yarp::dev::PidControlTypeEnum& pidtype,double *refs) override;
298 bool getPidErrorLimitRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j, double *limit) override;
299 bool getPidErrorLimitsRaw(const yarp::dev::PidControlTypeEnum& pidtype,double *limits) override;
300 bool resetPidRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j) override;
301 bool disablePidRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j) override;
302 bool enablePidRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j) override;
303 bool setPidOffsetRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j, double v) override;
304 bool isPidEnabledRaw(const yarp::dev::PidControlTypeEnum& pidtype, int j, bool* enabled) override;
305
306 // POSITION CONTROL INTERFACE RAW
307 bool getAxes(int *ax) override;
308 bool positionMoveRaw(int j, double ref) override;
309 bool positionMoveRaw(const double *refs) override;
310 bool relativeMoveRaw(int j, double delta) override;
311 bool relativeMoveRaw(const double *deltas) override;
312 bool checkMotionDoneRaw(bool *flag) override;
313 bool checkMotionDoneRaw(int j, bool *flag) override;
314 bool setRefSpeedRaw(int j, double sp) override;
315 bool setRefSpeedsRaw(const double *spds) override;
316 bool setRefAccelerationRaw(int j, double acc) override;
317 bool setRefAccelerationsRaw(const double *accs) override;
318 bool getRefSpeedRaw(int j, double *ref) override;
319 bool getRefSpeedsRaw(double *spds) override;
320 bool getRefAccelerationRaw(int j, double *acc) override;
321 bool getRefAccelerationsRaw(double *accs) override;
322 bool stopRaw(int j) override;
323 bool stopRaw() override;
324
325 // Position Control2 Interface
326 bool positionMoveRaw(const int n_joint, const int *joints, const double *refs) override;
327 bool relativeMoveRaw(const int n_joint, const int *joints, const double *deltas) override;
328 bool checkMotionDoneRaw(const int n_joint, const int *joints, bool *flags) override;
329 bool setRefSpeedsRaw(const int n_joint, const int *joints, const double *spds) override;
330 bool setRefAccelerationsRaw(const int n_joint, const int *joints, const double *accs) override;
331 bool getRefSpeedsRaw(const int n_joint, const int *joints, double *spds) override;
332 bool getRefAccelerationsRaw(const int n_joint, const int *joints, double *accs) override;
333 bool stopRaw(const int n_joint, const int *joints) override;
334 bool getTargetPositionRaw(const int joint, double *ref) override;
335 bool getTargetPositionsRaw(double *refs) override;
336 bool getTargetPositionsRaw(const int n_joint, const int *joints, double *refs) override;
337
338 // Velocity control interface raw
339 bool velocityMoveRaw(int j, double sp) override;
340 bool velocityMoveRaw(const double *sp) override;
341
342 // IJointFault
343 bool getLastJointFaultRaw(int j, int& fault, std::string& message) override;
344
345 // calibration2raw
346 bool setCalibrationParametersRaw(int axis, const yarp::dev::CalibrationParameters& params) override;
347 bool calibrateAxisWithParamsRaw(int axis, unsigned int type, double p1, double p2, double p3) override;
348 bool calibrationDoneRaw(int j) override;
349
350
352
353 // ControlMode
354 bool getControlModeRaw(int j, int *v) override;
355 bool getControlModesRaw(int *v) override;
356
357 // ControlMode 2
358 bool getControlModesRaw(const int n_joint, const int *joints, int *modes) override;
359 bool setControlModeRaw(const int j, const int mode) override;
360 bool setControlModesRaw(const int n_joint, const int *joints, int *modes) override;
361 bool setControlModesRaw(int *modes) override;
362
364 bool resetEncoderRaw(int j) override;
365 bool resetEncodersRaw() override;
366 bool setEncoderRaw(int j, double val) override;
367 bool setEncodersRaw(const double *vals) override;
368 bool getEncoderRaw(int j, double *v) override;
369 bool getEncodersRaw(double *encs) override;
370 bool getEncoderSpeedRaw(int j, double *sp) override;
371 bool getEncoderSpeedsRaw(double *spds) override;
372 bool getEncoderAccelerationRaw(int j, double *spds) override;
373 bool getEncoderAccelerationsRaw(double *accs) override;
375
376 bool getEncodersTimedRaw(double *encs, double *stamps) override;
377 bool getEncoderTimedRaw(int j, double *encs, double *stamp) override;
378
380 bool getNumberOfMotorEncodersRaw(int * num) override;
381 bool resetMotorEncoderRaw(int m) override;
382 bool resetMotorEncodersRaw() override;
383 bool setMotorEncoderRaw(int m, const double val) override;
384 bool setMotorEncodersRaw(const double *vals) override;
385 bool getMotorEncoderRaw(int m, double *v) override;
386 bool getMotorEncodersRaw(double *encs) override;
387 bool getMotorEncoderSpeedRaw(int m, double *sp) override;
388 bool getMotorEncoderSpeedsRaw(double *spds) override;
389 bool getMotorEncoderAccelerationRaw(int m, double *spds) override;
390 bool getMotorEncoderAccelerationsRaw(double *accs) override;
391 bool getMotorEncodersTimedRaw(double *encs, double *stamps) override;
392 bool getMotorEncoderTimedRaw(int m, double *encs, double *stamp) override;
393 bool getMotorEncoderCountsPerRevolutionRaw(int m, double *v) override;
394 bool setMotorEncoderCountsPerRevolutionRaw(int m, const double cpr) override;
396
398 bool getAxisNameRaw(int axis, std::string& name) override;
399 bool getJointTypeRaw(int axis, yarp::dev::JointTypeEnum& type) override;
401
402 //Internal use, not exposed by YARP (yet)
403 virtual bool getRotorEncoderResolutionRaw(int m, double &rotres);
404 virtual bool getJointEncoderResolutionRaw(int m, double &jntres);
405 virtual bool getJointEncoderTypeRaw(int j, int &type);
406 virtual bool getRotorEncoderTypeRaw(int j, int &type);
407 virtual bool getKinematicMJRaw(int j, double &rotres);
408 virtual bool getHasTempSensorsRaw(int j, int& ret);
409 virtual bool getHasHallSensorRaw(int j, int& ret);
410 virtual bool getHasRotorEncoderRaw(int j, int& ret);
411 virtual bool getHasRotorEncoderIndexRaw(int j, int& ret);
412 virtual bool getMotorPolesRaw(int j, int& poles);
413 virtual bool getRotorIndexOffsetRaw(int j, double& rotorOffset);
414 virtual bool getTorqueControlFilterType(int j, int& type);
415
417 bool enableAmpRaw(int j) override;
418 bool disableAmpRaw(int j) override;
419 bool getCurrentsRaw(double *vals) override;
420 bool getCurrentRaw(int j, double *val) override;
421 bool getNominalCurrentRaw(int m, double *val) override;
422 bool setNominalCurrentRaw(int m, const double val) override;
423 bool setMaxCurrentRaw(int j, double val) override;
424 bool getMaxCurrentRaw(int j, double *val) override;
425 bool getPeakCurrentRaw(int m, double *val) override;
426 bool setPeakCurrentRaw(int m, const double val) override;
427 bool getAmpStatusRaw(int *st) override;
428 bool getAmpStatusRaw(int j, int *st) override;
429 bool getPWMRaw(int j, double* val) override;
430 bool getPWMLimitRaw(int j, double* val) override;
431 bool setPWMLimitRaw(int j, const double val) override;
432 bool getPowerSupplyVoltageRaw(int j, double* val) override;
434
435 // Limits
436 bool setLimitsRaw(int axis, double min, double max) override;
437 bool getLimitsRaw(int axis, double *min, double *max) override;
438 // Limits 2
439 bool setVelLimitsRaw(int axis, double min, double max) override;
440 bool getVelLimitsRaw(int axis, double *min, double *max) override;
441
442 // Torque control
443 bool getTorqueRaw(int j, double *t) override;
444 bool getTorquesRaw(double *t) override;
445 bool getTorqueRangeRaw(int j, double *min, double *max) override;
446 bool getTorqueRangesRaw(double *min, double *max) override;
447 bool setRefTorquesRaw(const double *t) override;
448 bool setRefTorqueRaw(int j, double t) override;
449 bool setRefTorquesRaw(const int n_joint, const int *joints, const double *t) override;
450 bool getRefTorquesRaw(double *t) override;
451 bool getRefTorqueRaw(int j, double *t) override;
452 bool getMotorTorqueParamsRaw(int j, yarp::dev::MotorTorqueParameters *params) override;
453 bool setMotorTorqueParamsRaw(int j, const yarp::dev::MotorTorqueParameters params) override;
454// int32_t getRefSpeedInTbl(uint8_t boardNum, int j, eOmeas_position_t pos) override;
455
456 // IVelocityControl interface
457 bool velocityMoveRaw(const int n_joint, const int *joints, const double *spds) override;
458 bool getRefVelocityRaw(const int joint, double *ref) override;
459 bool getRefVelocitiesRaw(double *refs) override;
460 bool getRefVelocitiesRaw(const int n_joint, const int *joints, double *refs) override;
461
462 // Impedance interface
463 bool getImpedanceRaw(int j, double *stiffness, double *damping) override;
464 bool setImpedanceRaw(int j, double stiffness, double damping) override;
465 bool setImpedanceOffsetRaw(int j, double offset) override;
466 bool getImpedanceOffsetRaw(int j, double *offset) override;
467 bool getCurrentImpedanceLimitRaw(int j, double *min_stiff, double *max_stiff, double *min_damp, double *max_damp) override;
468
469 // PositionDirect Interface
470 bool setPositionRaw(int j, double ref) override;
471 bool setPositionsRaw(const int n_joint, const int *joints, const double *refs) override;
472 bool setPositionsRaw(const double *refs) override;
473 bool getRefPositionRaw(const int joint, double *ref) override;
474 bool getRefPositionsRaw(double *refs) override;
475 bool getRefPositionsRaw(const int n_joint, const int *joints, double *refs) override;
476
477 // InteractionMode interface
478 bool getInteractionModeRaw(int j, yarp::dev::InteractionModeEnum* _mode) override;
479 bool getInteractionModesRaw(int n_joints, int *joints, yarp::dev::InteractionModeEnum* modes) override;
480 bool getInteractionModesRaw(yarp::dev::InteractionModeEnum* modes) override;
481 bool setInteractionModeRaw(int j, yarp::dev::InteractionModeEnum _mode) override;
482 bool setInteractionModesRaw(int n_joints, int *joints, yarp::dev::InteractionModeEnum* modes) override;
483 bool setInteractionModesRaw(yarp::dev::InteractionModeEnum* modes) override;
484
485 // IMotor interface
486 bool getNumberOfMotorsRaw(int * num) override;
487 bool getTemperatureRaw(int m, double* val) override;
488 bool getTemperaturesRaw(double *vals) override;
489 bool getTemperatureLimitRaw(int m, double *temp) override;
490 bool setTemperatureLimitRaw(int m, const double temp) override;
491 bool getGearboxRatioRaw(int m, double* gearbox) override;
492 bool setGearboxRatioRaw(int m, const double val) override;
493
494 // PWM interface
495 bool setRefDutyCycleRaw(int j, double v) override;
496 bool setRefDutyCyclesRaw(const double *v) override;
497 bool getRefDutyCycleRaw(int j, double *v) override;
498 bool getRefDutyCyclesRaw(double *v) override;
499 bool getDutyCycleRaw(int j, double *v) override;
500 bool getDutyCyclesRaw(double *v) override;
501
502 //IJointBrake
503 yarp::dev::ReturnValue isJointBrakedRaw(int j, bool& braked) const override;
504 yarp::dev::ReturnValue setManualBrakeActiveRaw(int j, bool active) override;
505 yarp::dev::ReturnValue setAutoBrakeEnabledRaw(int j, bool enabled) override;
506 yarp::dev::ReturnValue getAutoBrakeEnabledRaw(int j, bool& enabled) const override;
507
508 // IVelocityDirect
509 yarp::dev::ReturnValue getAxes(size_t& axes) override;
510 yarp::dev::ReturnValue setDesiredVelocityRaw(int jnt, double vel) override;
511 yarp::dev::ReturnValue setDesiredVelocityRaw(const std::vector<double>& vels) override;
512 yarp::dev::ReturnValue setDesiredVelocityRaw(const std::vector<int>& jnts, const std::vector<double>& vels) override;
513 yarp::dev::ReturnValue getDesiredVelocityRaw(const int jnt, double& vel) override;
514 yarp::dev::ReturnValue getDesiredVelocityRaw(std::vector<double>& vels) override;
515 yarp::dev::ReturnValue getDesiredVelocityRaw(const std::vector<int>& jnts, std::vector<double>& vels) override;
516
517 // Current interface
518 //bool getAxes(int *ax) override;
519 //bool getCurrentRaw(int j, double *t) override;
520 //bool getCurrentsRaw(double *t) override;
521 bool getCurrentRangeRaw(int j, double *min, double *max) override;
522 bool getCurrentRangesRaw(double *min, double *max) override;
523 bool setRefCurrentsRaw(const double *t) override;
524 bool setRefCurrentRaw(int j, double t) override;
525 bool setRefCurrentsRaw(const int n_joint, const int *joints, const double *t) override;
526 bool getRefCurrentsRaw(double *t) override;
527 bool getRefCurrentRaw(int j, double *t) override;
528
529 yarp::dev::VAS_status getVirtualAnalogSensorStatusRaw(int ch) override;
530 int getVirtualAnalogSensorChannelsRaw() override;
531 bool updateVirtualAnalogSensorMeasureRaw(yarp::sig::Vector &measure) override;
532 bool updateVirtualAnalogSensorMeasureRaw(int ch, double &measure) override;
533
534 void run() override;
535private:
536 void cleanup();
537 bool dealloc();
538
539 //bool parsePositionPidsGroup(yarp::os::Bottle& pidsGroup, yarp::dev::Pid myPid[]);
540 //bool parseTorquePidsGroup(yarp::os::Bottle& pidsGroup, yarp::dev::Pid myPid[], double kbemf[], double ktau[], int filterType[], double viscousPos[], double viscousNeg[], double coulombPos[], double coulombNeg[], double velocityThres[]);
541 //bool parseImpedanceGroup_NewFormat(yarp::os::Bottle& pidsGroup, ImpedanceParameters vals[]);
542 //bool extractGroup(yarp::os::Bottle &input, yarp::os::Bottle &out, const std::string &key1, const std::string &txt, int size);
543};
544
545#endif // YARP_DEVICE_FAKE_MOTIONCONTROL
ControlBoardInterfaces.h
define control board standard interfaces
mode
FeatureMode mode
Definition FakeFrameGrabber_Controls.cpp:33
FakeMotionControl_ParamsParser.h
IVirtualAnalogSensor.h
virtual analog sensor interface
ret
bool ret
Definition ImplementAxisInfo.cpp:77
Vector.h
contains the definition of a Vector type
FakeMotionControl_ParamsParser
This class is the parameters parser for class FakeMotionControl.
Definition FakeMotionControl_ParamsParser.h:50
FakeMotionControl
fakeMotionControl: The aim of this device is to mimic the expected behavior of a real motion control ...
Definition FakeMotionControl.h:133
FakeMotionControl::getPowerSupplyVoltageRaw
bool getPowerSupplyVoltageRaw(int j, double *val) override
Definition FakeMotionControl.cpp:1945
FakeMotionControl::getRefSpeedRaw
bool getRefSpeedRaw(int j, double *ref) override
Get reference speed for a joint.
Definition FakeMotionControl.cpp:1381
FakeMotionControl::getHasTempSensorsRaw
virtual bool getHasTempSensorsRaw(int j, int &ret)
Definition FakeMotionControl.cpp:2006
FakeMotionControl::setRefCurrentsRaw
bool setRefCurrentsRaw(const double *t) override
Set the reference value of the currents for all motors.
Definition FakeMotionControl.cpp:2544
FakeMotionControl::setRefTorqueRaw
bool setRefTorqueRaw(int j, double t) override
Set the reference value of the torque for a given joint.
Definition FakeMotionControl.cpp:2118
FakeMotionControl::getCurrentsRaw
bool getCurrentsRaw(double *vals) override
Definition FakeMotionControl.cpp:1864
FakeMotionControl::getImpedanceOffsetRaw
bool getImpedanceOffsetRaw(int j, double *offset) override
Get current force Offset for a specific joint.
Definition FakeMotionControl.cpp:2171
FakeMotionControl::getTargetPositionRaw
bool getTargetPositionRaw(const int joint, double *ref) override
Get the last position reference for the specified axis.
Definition FakeMotionControl.cpp:2264
FakeMotionControl::getTorqueRangeRaw
bool getTorqueRangeRaw(int j, double *min, double *max) override
Get the full scale of the torque sensor of a given joint.
Definition FakeMotionControl.cpp:2093
FakeMotionControl::getCurrentImpedanceLimitRaw
bool getCurrentImpedanceLimitRaw(int j, double *min_stiff, double *max_stiff, double *min_damp, double *max_damp) override
Get the current impedandance limits for a specific joint.
Definition FakeMotionControl.cpp:2176
FakeMotionControl::setTemperatureLimitRaw
bool setTemperatureLimitRaw(int m, const double temp) override
Set the temperature limit for a specific motor.
Definition FakeMotionControl.cpp:2460
FakeMotionControl::getPidErrorRaw
bool getPidErrorRaw(const yarp::dev::PidControlTypeEnum &pidtype, int j, double *err) override
Get the current error for a joint.
Definition FakeMotionControl.cpp:887
FakeMotionControl::setPeakCurrentRaw
bool setPeakCurrentRaw(int m, const double val) override
Definition FakeMotionControl.cpp:1909
FakeMotionControl::velocityMoveRaw
bool velocityMoveRaw(int j, double sp) override
Start motion at a given speed, single joint.
Definition FakeMotionControl.cpp:1153
FakeMotionControl::setAutoBrakeEnabledRaw
yarp::dev::ReturnValue setAutoBrakeEnabledRaw(int j, bool enabled) override
Definition FakeMotionControl.cpp:2632
FakeMotionControl::checkMotionDoneRaw
bool checkMotionDoneRaw(bool *flag) override
Check if the current trajectory is terminated.
Definition FakeMotionControl.cpp:1300
FakeMotionControl::getMotorEncoderSpeedRaw
bool getMotorEncoderSpeedRaw(int m, double *sp) override
Read the istantaneous speed of a motor encoder.
Definition FakeMotionControl.cpp:1790
FakeMotionControl::getJointEncoderTypeRaw
virtual bool getJointEncoderTypeRaw(int j, int &type)
Definition FakeMotionControl.cpp:1991
FakeMotionControl::setRefDutyCycleRaw
bool setRefDutyCycleRaw(int j, double v) override
Sets the reference dutycycle of a single motor.
Definition FakeMotionControl.cpp:2466
FakeMotionControl::getTemperatureRaw
bool getTemperatureRaw(int m, double *val) override
Get temperature of a motor.
Definition FakeMotionControl.cpp:2439
FakeMotionControl::getEncoderAccelerationRaw
bool getEncoderAccelerationRaw(int j, double *spds) override
Read the instantaneous acceleration of an axis.
Definition FakeMotionControl.cpp:1694
FakeMotionControl::getRefAccelerationRaw
bool getRefAccelerationRaw(int j, double *acc) override
Get reference acceleration for a joint.
Definition FakeMotionControl.cpp:1393
FakeMotionControl::getMotorEncoderSpeedsRaw
bool getMotorEncoderSpeedsRaw(double *spds) override
Read the instantaneous speed of all motor encoders.
Definition FakeMotionControl.cpp:1796
FakeMotionControl::setPidsRaw
bool setPidsRaw(const yarp::dev::PidControlTypeEnum &pidtype, const yarp::dev::Pid *pids) override
Set new pid value on multiple axes.
Definition FakeMotionControl.cpp:813
FakeMotionControl::setVelLimitsRaw
bool setVelLimitsRaw(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...
Definition FakeMotionControl.cpp:2064
FakeMotionControl::getJointTypeRaw
bool getJointTypeRaw(int axis, yarp::dev::JointTypeEnum &type) override
Definition FakeMotionControl.cpp:2050
FakeMotionControl::setMotorEncoderRaw
bool setMotorEncoderRaw(int m, const double val) override
Set the value of the motor encoder for a given motor.
Definition FakeMotionControl.cpp:1743
FakeMotionControl::getPidErrorLimitRaw
bool getPidErrorLimitRaw(const yarp::dev::PidControlTypeEnum &pidtype, int j, double *limit) override
Get the error limit for the controller on a specific joint.
Definition FakeMotionControl.cpp:990
FakeMotionControl::getPidOutputRaw
bool getPidOutputRaw(const yarp::dev::PidControlTypeEnum &pidtype, int j, double *out) override
Get the output of the controller (e.g.
Definition FakeMotionControl.cpp:1116
FakeMotionControl::setControlModeRaw
bool setControlModeRaw(const int j, const int mode) override
Definition FakeMotionControl.cpp:1584
FakeMotionControl::getMotorEncoderAccelerationRaw
bool getMotorEncoderAccelerationRaw(int m, double *spds) override
Read the instantaneous acceleration of a motor encoder.
Definition FakeMotionControl.cpp:1806
FakeMotionControl::open
bool open(yarp::os::Searchable &par) override
Open the DeviceDriver.
Definition FakeMotionControl.cpp:529
FakeMotionControl::getHasHallSensorRaw
virtual bool getHasHallSensorRaw(int j, int &ret)
Definition FakeMotionControl.cpp:2011
FakeMotionControl::getTemperatureLimitRaw
bool getTemperatureLimitRaw(int m, double *temp) override
Retreives the current temperature limit for a specific motor.
Definition FakeMotionControl.cpp:2455
FakeMotionControl::getNumberOfMotorsRaw
bool getNumberOfMotorsRaw(int *num) override
Get the number of available motors.
Definition FakeMotionControl.cpp:2433
FakeMotionControl::disableAmpRaw
bool disableAmpRaw(int j) override
Disable the amplifier on a specific joint.
Definition FakeMotionControl.cpp:1852
FakeMotionControl::setMotorTorqueParamsRaw
bool setMotorTorqueParamsRaw(int j, const yarp::dev::MotorTorqueParameters params) override
Set the motor parameters.
Definition FakeMotionControl.cpp:2204
FakeMotionControl::calibrateAxisWithParamsRaw
bool calibrateAxisWithParamsRaw(int axis, unsigned int type, double p1, double p2, double p3) override
Start calibration, this method is very often platform specific.
Definition FakeMotionControl.cpp:1190
FakeMotionControl::setRefAccelerationRaw
bool setRefAccelerationRaw(int j, double acc) override
Set reference acceleration for a joint.
Definition FakeMotionControl.cpp:1338
FakeMotionControl::initialised
virtual bool initialised()
Definition FakeMotionControl.cpp:499
FakeMotionControl::setGearboxRatioRaw
bool setGearboxRatioRaw(int m, const double val) override
Set the gearbox ratio for a specific motor.
Definition FakeMotionControl.cpp:1971
FakeMotionControl::setEncodersRaw
bool setEncodersRaw(const double *vals) override
Set the value of all encoders.
Definition FakeMotionControl.cpp:1639
FakeMotionControl::getPidOutputsRaw
bool getPidOutputsRaw(const yarp::dev::PidControlTypeEnum &pidtype, double *outs) override
Get the output of the controllers (e.g.
Definition FakeMotionControl.cpp:1139
FakeMotionControl::isPidEnabledRaw
bool isPidEnabledRaw(const yarp::dev::PidControlTypeEnum &pidtype, int j, bool *enabled) override
Get the current status (enabled/disabled) of the pid controller.
Definition FakeMotionControl.cpp:1094
FakeMotionControl::setRefSpeedsRaw
bool setRefSpeedsRaw(const double *spds) override
Set reference speed on all joints.
Definition FakeMotionControl.cpp:1327
FakeMotionControl::getTargetPositionsRaw
bool getTargetPositionsRaw(double *refs) override
Get the last position reference for all axes.
Definition FakeMotionControl.cpp:2283
FakeMotionControl::getRefDutyCycleRaw
bool getRefDutyCycleRaw(int j, double *v) override
Gets the last reference sent using the setRefDutyCycleRaw function.
Definition FakeMotionControl.cpp:2483
FakeMotionControl::setMotorEncoderCountsPerRevolutionRaw
bool setMotorEncoderCountsPerRevolutionRaw(int m, const double cpr) override
Sets number of counts per revolution for motor encoder m.
Definition FakeMotionControl.cpp:1753
FakeMotionControl::setPidErrorLimitsRaw
bool setPidErrorLimitsRaw(const yarp::dev::PidControlTypeEnum &pidtype, const double *limits) override
Get the error limit for the controller on all joints.
Definition FakeMotionControl.cpp:877
FakeMotionControl::getPidReferenceRaw
bool getPidReferenceRaw(const yarp::dev::PidControlTypeEnum &pidtype, int j, double *ref) override
Get the current reference of the pid controller for a specific joint.
Definition FakeMotionControl.cpp:955
FakeMotionControl::getNominalCurrentRaw
bool getNominalCurrentRaw(int m, double *val) override
Definition FakeMotionControl.cpp:1915
FakeMotionControl::getControlModeRaw
bool getControlModeRaw(int j, int *v) override
Definition FakeMotionControl.cpp:1553
FakeMotionControl::calibrationDoneRaw
bool calibrationDoneRaw(int j) override
Check if the calibration is terminated, on a particular joint.
Definition FakeMotionControl.cpp:1196
FakeMotionControl::threadInit
bool threadInit() override
Initialization method.
Definition FakeMotionControl.cpp:504
FakeMotionControl::getRefDutyCyclesRaw
bool getRefDutyCyclesRaw(double *v) override
Gets the last reference sent using the setRefDutyCyclesRaw function.
Definition FakeMotionControl.cpp:2489
FakeMotionControl::getRefVelocityRaw
bool getRefVelocityRaw(const int joint, double *ref) override
Get the last reference speed set by velocityMove for single joint.
Definition FakeMotionControl.cpp:2302
FakeMotionControl::getEncoderTimedRaw
bool getEncoderTimedRaw(int j, double *encs, double *stamp) override
Read the instantaneous acceleration of all axes.
Definition FakeMotionControl.cpp:1725
FakeMotionControl::disablePidRaw
bool disablePidRaw(const yarp::dev::PidControlTypeEnum &pidtype, int j) override
Disable the pid computation for a joint.
Definition FakeMotionControl.cpp:1027
FakeMotionControl::getVirtualAnalogSensorStatusRaw
yarp::dev::VAS_status getVirtualAnalogSensorStatusRaw(int ch) override
Check the status of a given channel.
Definition FakeMotionControl.cpp:2586
FakeMotionControl::getMotorEncodersRaw
bool getMotorEncodersRaw(double *encs) override
Read the position of all motor encoders.
Definition FakeMotionControl.cpp:1779
FakeMotionControl::getTorqueRangesRaw
bool getTorqueRangesRaw(double *min, double *max) override
Get the full scale of the torque sensors of all joints.
Definition FakeMotionControl.cpp:2100
FakeMotionControl::getRefCurrentsRaw
bool getRefCurrentsRaw(double *t) override
Get the reference value of the currents for all motors.
Definition FakeMotionControl.cpp:2571
FakeMotionControl::setRefDutyCyclesRaw
bool setRefDutyCyclesRaw(const double *v) override
Sets the reference dutycycle for all motors.
Definition FakeMotionControl.cpp:2474
FakeMotionControl::getEncoderSpeedRaw
bool getEncoderSpeedRaw(int j, double *sp) override
Read the instantaneous speed of an axis.
Definition FakeMotionControl.cpp:1677
FakeMotionControl::getVirtualAnalogSensorChannelsRaw
int getVirtualAnalogSensorChannelsRaw() override
Get the number of channels of the virtual sensor.
Definition FakeMotionControl.cpp:2591
FakeMotionControl::resetPidRaw
bool resetPidRaw(const yarp::dev::PidControlTypeEnum &pidtype, int j) override
Reset the controller of a given joint, usually sets the current status of the joint as the reference ...
Definition FakeMotionControl.cpp:1022
FakeMotionControl::getCurrentRangesRaw
bool getCurrentRangesRaw(double *min, double *max) override
Get the full scale of the current measurements for all motors motor (e.g.
Definition FakeMotionControl.cpp:2533
FakeMotionControl::getDesiredVelocityRaw
yarp::dev::ReturnValue getDesiredVelocityRaw(const int jnt, double &vel) override
Get the last reference velocity set by setDesiredVelocity() for a single joint.
Definition FakeMotionControl.cpp:2691
FakeMotionControl::getEncoderRaw
bool getEncoderRaw(int j, double *v) override
Read the value of an encoder.
Definition FakeMotionControl.cpp:1654
FakeMotionControl::getPidErrorLimitsRaw
bool getPidErrorLimitsRaw(const yarp::dev::PidControlTypeEnum &pidtype, double *limits) override
Get the error limit for all controllers.
Definition FakeMotionControl.cpp:1012
FakeMotionControl::enableAmpRaw
bool enableAmpRaw(int j) override
Enable the amplifier on a specific joint.
Definition FakeMotionControl.cpp:1847
FakeMotionControl::fromConfig
bool fromConfig(yarp::os::Searchable &config)
Definition FakeMotionControl.cpp:609
FakeMotionControl::setManualBrakeActiveRaw
yarp::dev::ReturnValue setManualBrakeActiveRaw(int j, bool active) override
Definition FakeMotionControl.cpp:2626
FakeMotionControl::getPidsRaw
bool getPidsRaw(const yarp::dev::PidControlTypeEnum &pidtype, yarp::dev::Pid *pids) override
Get current pid value for a specific joint.
Definition FakeMotionControl.cpp:942
FakeMotionControl::getRefPositionsRaw
bool getRefPositionsRaw(double *refs) override
Get the last position reference for all axes.
Definition FakeMotionControl.cpp:2346
FakeMotionControl::getMotorTorqueParamsRaw
bool getMotorTorqueParamsRaw(int j, yarp::dev::MotorTorqueParameters *params) override
Get the motor parameters.
Definition FakeMotionControl.cpp:2181
FakeMotionControl::setControlModesRaw
bool setControlModesRaw(const int n_joint, const int *joints, int *modes) override
Definition FakeMotionControl.cpp:1603
FakeMotionControl::setRefSpeedRaw
bool setRefSpeedRaw(int j, double sp) override
Set reference speed for a joint, this is the speed used during the interpolation of the trajectory.
Definition FakeMotionControl.cpp:1318
FakeMotionControl::getHasRotorEncoderIndexRaw
virtual bool getHasRotorEncoderIndexRaw(int j, int &ret)
Definition FakeMotionControl.cpp:2021
FakeMotionControl::updateVirtualAnalogSensorMeasureRaw
bool updateVirtualAnalogSensorMeasureRaw(yarp::sig::Vector &measure) override
Set a vector of torque values for virtual sensor.
Definition FakeMotionControl.cpp:2596
FakeMotionControl::resizeBuffers
void resizeBuffers()
Resize previously allocated buffers.
Definition FakeMotionControl.cpp:167
FakeMotionControl::isJointBrakedRaw
yarp::dev::ReturnValue isJointBrakedRaw(int j, bool &braked) const override
Definition FakeMotionControl.cpp:2620
FakeMotionControl::threadRelease
void threadRelease() override
Release method.
Definition FakeMotionControl.cpp:525
FakeMotionControl::getAmpStatusRaw
bool getAmpStatusRaw(int *st) override
Definition FakeMotionControl.cpp:1893
FakeMotionControl::getLastJointFaultRaw
bool getLastJointFaultRaw(int j, int &fault, std::string &message) override
Definition FakeMotionControl.cpp:2611
FakeMotionControl::setImpedanceRaw
bool setImpedanceRaw(int j, double stiffness, double damping) override
Set current impedance parameters (stiffness,damping) for a specific joint.
Definition FakeMotionControl.cpp:2161
FakeMotionControl::setPWMLimitRaw
bool setPWMLimitRaw(int j, const double val) override
Definition FakeMotionControl.cpp:1939
FakeMotionControl::relativeMoveRaw
bool relativeMoveRaw(int j, double delta) override
Set relative position.
Definition FakeMotionControl.cpp:1251
FakeMotionControl::getMotorPolesRaw
virtual bool getMotorPolesRaw(int j, int &poles)
Definition FakeMotionControl.cpp:2026
FakeMotionControl::getPidRaw
bool getPidRaw(const yarp::dev::PidControlTypeEnum &pidtype, int j, yarp::dev::Pid *pid) override
Get current pid value for a specific joint.
Definition FakeMotionControl.cpp:919
FakeMotionControl::getCurrentRaw
bool getCurrentRaw(int j, double *val) override
Definition FakeMotionControl.cpp:1857
FakeMotionControl::getPeakCurrentRaw
bool getPeakCurrentRaw(int m, double *val) override
Definition FakeMotionControl.cpp:1903
FakeMotionControl::getDutyCyclesRaw
bool getDutyCyclesRaw(double *v) override
Gets the current dutycycle of the output of the amplifier (i.e.
Definition FakeMotionControl.cpp:2504
FakeMotionControl::setEncoderRaw
bool setEncoderRaw(int j, double val) override
Set the value of the encoder for a given joint.
Definition FakeMotionControl.cpp:1634
FakeMotionControl::getRefPositionRaw
bool getRefPositionRaw(const int joint, double *ref) override
Get the last position reference for the specified axis.
Definition FakeMotionControl.cpp:2328
FakeMotionControl::getLimitsRaw
bool getLimitsRaw(int axis, double *min, double *max) override
Get the software limits for a particular axis.
Definition FakeMotionControl.cpp:1959
FakeMotionControl::getRotorIndexOffsetRaw
virtual bool getRotorIndexOffsetRaw(int j, double &rotorOffset)
Definition FakeMotionControl.cpp:2031
FakeMotionControl::getVelLimitsRaw
bool getVelLimitsRaw(int axis, double *min, double *max) override
Get the software speed limits for a particular axis.
Definition FakeMotionControl.cpp:2069
FakeMotionControl::setPositionsRaw
bool setPositionsRaw(const int n_joint, const int *joints, const double *refs) override
Set new reference point for all axes.
Definition FakeMotionControl.cpp:2245
FakeMotionControl::setPidReferenceRaw
bool setPidReferenceRaw(const yarp::dev::PidControlTypeEnum &pidtype, int j, double ref) override
Set the controller reference for a given axis.
Definition FakeMotionControl.cpp:823
FakeMotionControl::resetEncodersRaw
bool resetEncodersRaw() override
Reset encoders.
Definition FakeMotionControl.cpp:1649
FakeMotionControl::getPWMRaw
bool getPWMRaw(int j, double *val) override
Definition FakeMotionControl.cpp:1927
FakeMotionControl::setDesiredVelocityRaw
yarp::dev::ReturnValue setDesiredVelocityRaw(int jnt, double vel) override
Set the velocity of single joint.
Definition FakeMotionControl.cpp:2650
FakeMotionControl::getAutoBrakeEnabledRaw
yarp::dev::ReturnValue getAutoBrakeEnabledRaw(int j, bool &enabled) const override
Definition FakeMotionControl.cpp:2638
FakeMotionControl::getAxisNameRaw
bool getAxisNameRaw(int axis, std::string &name) override
Definition FakeMotionControl.cpp:2036
FakeMotionControl::setCalibrationParametersRaw
bool setCalibrationParametersRaw(int axis, const yarp::dev::CalibrationParameters &params) override
Start calibration, this method is very often platform specific.
Definition FakeMotionControl.cpp:1184
FakeMotionControl::setPidOffsetRaw
bool setPidOffsetRaw(const yarp::dev::PidControlTypeEnum &pidtype, int j, double v) override
Set an offset value on the ourput of pid controller.
Definition FakeMotionControl.cpp:1071
FakeMotionControl::getInteractionModeRaw
bool getInteractionModeRaw(int j, yarp::dev::InteractionModeEnum *_mode) override
Get the current interaction mode of the robot, values can be stiff or compliant.
Definition FakeMotionControl.cpp:2368
FakeMotionControl::getCurrentRangeRaw
bool getCurrentRangeRaw(int j, double *min, double *max) override
Get the full scale of the current measurement for a given motor (e.g.
Definition FakeMotionControl.cpp:2525
FakeMotionControl::stopRaw
bool stopRaw() override
Stop motion, multiple joints.
Definition FakeMotionControl.cpp:1411
FakeMotionControl::getKinematicMJRaw
virtual bool getKinematicMJRaw(int j, double &rotres)
Definition FakeMotionControl.cpp:2001
FakeMotionControl::getRefSpeedsRaw
bool getRefSpeedsRaw(double *spds) override
Get reference speed of all joints.
Definition FakeMotionControl.cpp:1387
FakeMotionControl::getRefAccelerationsRaw
bool getRefAccelerationsRaw(double *accs) override
Get reference acceleration of all joints.
Definition FakeMotionControl.cpp:1399
FakeMotionControl::getJointEncoderResolutionRaw
virtual bool getJointEncoderResolutionRaw(int m, double &jntres)
Definition FakeMotionControl.cpp:1986
FakeMotionControl::getAxes
bool getAxes(int *ax) override
Get the number of controlled axes.
Definition FakeMotionControl.cpp:1205
FakeMotionControl::setMaxCurrentRaw
bool setMaxCurrentRaw(int j, double val) override
Definition FakeMotionControl.cpp:1875
FakeMotionControl::alloc
bool alloc(int njoints)
Allocated buffers.
Definition FakeMotionControl.cpp:207
FakeMotionControl::resetMotorEncodersRaw
bool resetMotorEncodersRaw() override
Reset motor encoders.
Definition FakeMotionControl.cpp:1768
FakeMotionControl::setRefTorquesRaw
bool setRefTorquesRaw(const double *t) override
Set the reference value of the torque for all joints.
Definition FakeMotionControl.cpp:2109
FakeMotionControl::getEncodersRaw
bool getEncodersRaw(double *encs) override
Read the position of all axes.
Definition FakeMotionControl.cpp:1665
FakeMotionControl::setRefAccelerationsRaw
bool setRefAccelerationsRaw(const double *accs) override
Set reference acceleration on all joints.
Definition FakeMotionControl.cpp:1359
FakeMotionControl::getControlModesRaw
bool getControlModesRaw(int *v) override
Definition FakeMotionControl.cpp:1564
FakeMotionControl::setPidRaw
bool setPidRaw(const yarp::dev::PidControlTypeEnum &pidtype, int j, const yarp::dev::Pid &pid) override
Set new pid value for a joint axis.
Definition FakeMotionControl.cpp:790
FakeMotionControl::getPWMLimitRaw
bool getPWMLimitRaw(int j, double *val) override
Definition FakeMotionControl.cpp:1933
FakeMotionControl::getRotorEncoderTypeRaw
virtual bool getRotorEncoderTypeRaw(int j, int &type)
Definition FakeMotionControl.cpp:1996
FakeMotionControl::getRefCurrentRaw
bool getRefCurrentRaw(int j, double *t) override
Get the reference value of the current for a single motor.
Definition FakeMotionControl.cpp:2580
FakeMotionControl::getDutyCycleRaw
bool getDutyCycleRaw(int j, double *v) override
Gets the current dutycycle of the output of the amplifier (i.e.
Definition FakeMotionControl.cpp:2498
FakeMotionControl::setPidErrorLimitRaw
bool setPidErrorLimitRaw(const yarp::dev::PidControlTypeEnum &pidtype, int j, double limit) override
Set the error limit for the controller on a specific joint.
Definition FakeMotionControl.cpp:855
FakeMotionControl::getInteractionModesRaw
bool getInteractionModesRaw(int n_joints, int *joints, yarp::dev::InteractionModeEnum *modes) override
Get the current interaction mode of the robot for a set of joints, values can be stiff or compliant.
Definition FakeMotionControl.cpp:2377
FakeMotionControl::positionMoveRaw
bool positionMoveRaw(int j, double ref) override
Set new reference point for a single axis.
Definition FakeMotionControl.cpp:1212
FakeMotionControl::getMotorEncoderCountsPerRevolutionRaw
bool getMotorEncoderCountsPerRevolutionRaw(int m, double *v) override
Gets number of counts per revolution for motor encoder m.
Definition FakeMotionControl.cpp:1758
FakeMotionControl::setImpedanceOffsetRaw
bool setImpedanceOffsetRaw(int j, double offset) override
Set current force Offset for a specific joint.
Definition FakeMotionControl.cpp:2166
FakeMotionControl::setMotorEncodersRaw
bool setMotorEncodersRaw(const double *vals) override
Set the value of all motor encoders.
Definition FakeMotionControl.cpp:1748
FakeMotionControl::getPidErrorsRaw
bool getPidErrorsRaw(const yarp::dev::PidControlTypeEnum &pidtype, double *errs) override
Get the error of all joints.
Definition FakeMotionControl.cpp:909
FakeMotionControl::getGearboxRatioRaw
bool getGearboxRatioRaw(int m, double *gearbox) override
Get the gearbox ratio for a specific motor.
Definition FakeMotionControl.cpp:1966
FakeMotionControl::getMaxCurrentRaw
bool getMaxCurrentRaw(int j, double *val) override
Returns the maximum electric current allowed for a given motor.
Definition FakeMotionControl.cpp:1881
FakeMotionControl::close
bool close() override
Close the DeviceDriver.
Definition FakeMotionControl.cpp:749
FakeMotionControl::getRefTorquesRaw
bool getRefTorquesRaw(double *t) override
Get the reference value of the torque for all joints.
Definition FakeMotionControl.cpp:2139
FakeMotionControl::setRefCurrentRaw
bool setRefCurrentRaw(int j, double t) override
Set the reference value of the current for a single motor.
Definition FakeMotionControl.cpp:2554
FakeMotionControl::getNumberOfMotorEncodersRaw
bool getNumberOfMotorEncodersRaw(int *num) override
Get the number of available motor encoders.
Definition FakeMotionControl.cpp:1737
FakeMotionControl::getPidReferencesRaw
bool getPidReferencesRaw(const yarp::dev::PidControlTypeEnum &pidtype, double *refs) override
Get the current reference of all pid controllers.
Definition FakeMotionControl.cpp:977
FakeMotionControl::getTorqueRaw
bool getTorqueRaw(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).
Definition FakeMotionControl.cpp:2078
FakeMotionControl::getImpedanceRaw
bool getImpedanceRaw(int j, double *stiffness, double *damping) override
Get current impedance parameters (stiffness,damping,offset) for a specific joint.
Definition FakeMotionControl.cpp:2156
FakeMotionControl::enablePidRaw
bool enablePidRaw(const yarp::dev::PidControlTypeEnum &pidtype, int j) override
Enable the pid computation for a joint.
Definition FakeMotionControl.cpp:1049
FakeMotionControl::getRefVelocitiesRaw
bool getRefVelocitiesRaw(double *refs) override
Get the last reference speed set by velocityMove for all joints.
Definition FakeMotionControl.cpp:2308
FakeMotionControl::setPositionRaw
bool setPositionRaw(int j, double ref) override
Set new position for a single axis.
Definition FakeMotionControl.cpp:2239
FakeMotionControl::getEncoderAccelerationsRaw
bool getEncoderAccelerationsRaw(double *accs) override
Read the instantaneous acceleration of all axes.
Definition FakeMotionControl.cpp:1702
FakeMotionControl::setPidReferencesRaw
bool setPidReferencesRaw(const yarp::dev::PidControlTypeEnum &pidtype, const double *refs) override
Set the controller reference, multiple axes.
Definition FakeMotionControl.cpp:845
FakeMotionControl::getMotorEncoderRaw
bool getMotorEncoderRaw(int m, double *v) override
Read the value of a motor encoder.
Definition FakeMotionControl.cpp:1773
FakeMotionControl::getRefTorqueRaw
bool getRefTorqueRaw(int j, double *t) override
Set the reference value of the torque for a given joint.
Definition FakeMotionControl.cpp:2148
FakeMotionControl::getMotorEncoderAccelerationsRaw
bool getMotorEncoderAccelerationsRaw(double *accs) override
Read the instantaneous acceleration of all motor encoders.
Definition FakeMotionControl.cpp:1812
FakeMotionControl::setInteractionModesRaw
bool setInteractionModesRaw(int n_joints, int *joints, yarp::dev::InteractionModeEnum *modes) override
Set the interaction mode of the robot for a set of joints, values can be stiff or compliant.
Definition FakeMotionControl.cpp:2412
FakeMotionControl::getTemperaturesRaw
bool getTemperaturesRaw(double *vals) override
Get temperature of all the motors.
Definition FakeMotionControl.cpp:2445
FakeMotionControl::resetMotorEncoderRaw
bool resetMotorEncoderRaw(int m) override
Reset motor encoder, single motor.
Definition FakeMotionControl.cpp:1763
FakeMotionControl::setNominalCurrentRaw
bool setNominalCurrentRaw(int m, const double val) override
Definition FakeMotionControl.cpp:1921
FakeMotionControl::getRotorEncoderResolutionRaw
virtual bool getRotorEncoderResolutionRaw(int m, double &rotres)
Definition FakeMotionControl.cpp:1981
FakeMotionControl::getHasRotorEncoderRaw
virtual bool getHasRotorEncoderRaw(int j, int &ret)
Definition FakeMotionControl.cpp:2016
FakeMotionControl::getMotorEncodersTimedRaw
bool getMotorEncodersTimedRaw(double *encs, double *stamps) override
Read the instantaneous position of all motor encoders.
Definition FakeMotionControl.cpp:1822
FakeMotionControl::resetEncoderRaw
bool resetEncoderRaw(int j) override
Reset encoder, single joint.
Definition FakeMotionControl.cpp:1644
FakeMotionControl::getTorquesRaw
bool getTorquesRaw(double *t) override
Get the value of the torque for all joints (this is the feedback if you have torque sensors).
Definition FakeMotionControl.cpp:2084
FakeMotionControl::setLimitsRaw
bool setLimitsRaw(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...
Definition FakeMotionControl.cpp:1953
FakeMotionControl::setInteractionModeRaw
bool setInteractionModeRaw(int j, yarp::dev::InteractionModeEnum _mode) override
Set the interaction mode of the robot, values can be stiff or compliant.
Definition FakeMotionControl.cpp:2400
FakeMotionControl::run
void run() override
Loop function.
Definition FakeMotionControl.cpp:34
FakeMotionControl::getMotorEncoderTimedRaw
bool getMotorEncoderTimedRaw(int m, double *encs, double *stamp) override
Read the instantaneous position of a motor encoder.
Definition FakeMotionControl.cpp:1834
FakeMotionControl::getEncodersTimedRaw
bool getEncodersTimedRaw(double *encs, double *stamps) override
Read the instantaneous acceleration of all axes.
Definition FakeMotionControl.cpp:1714
FakeMotionControl::getEncoderSpeedsRaw
bool getEncoderSpeedsRaw(double *spds) override
Read the instantaneous acceleration of an axis.
Definition FakeMotionControl.cpp:1684
FakeMotionControl::getTorqueControlFilterType
virtual bool getTorqueControlFilterType(int j, int &type)
Definition FakeMotionControl.cpp:1976
yarp::dev::DeviceDriver
Interface implemented by all device drivers.
Definition DeviceDriver.h:29
yarp::dev::IAmplifierControlRaw
Interface for control devices, amplifier commands.
Definition IAmplifierControl.h:173
yarp::dev::IAxisInfoRaw
Interface for getting information about specific axes, if available.
Definition IAxisInfo.h:72
yarp::dev::IControlCalibrationRaw
Interface for control devices, calibration commands.
Definition IControlCalibration.h:44
yarp::dev::IControlLimitsRaw
Interface for control devices.
Definition IControlLimits.h:78
yarp::dev::IControlModeRaw
Interface for setting control mode in control board.
Definition IControlMode.h:99
yarp::dev::ICurrentControlRaw
Interface for control boards implementing current control.
Definition ICurrentControl.h:110
yarp::dev::IEncodersTimedRaw
Control board, extend encoder raw interface adding timestamps.
Definition IEncodersTimed.h:23
yarp::dev::IImpedanceControlRaw
Interface for control boards implementing impedance control.
Definition IImpedanceControl.h:23
yarp::dev::IInteractionModeRaw
Interface settings the way the robot interacts with the environment: basic interaction types are Stif...
Definition IInteractionMode.h:117
yarp::dev::IJointBrakeRaw
Interface for controlling a joint equipped with brakes (hardware or simulated).
Definition IJointBrake.h:70
yarp::dev::IJointFaultRaw
Interface for getting info about the fault which may occur on a robot.
Definition IJointFault.h:35
yarp::dev::IMotorEncodersRaw
Control board, encoder interface.
Definition IMotorEncoders.h:23
yarp::dev::IMotorRaw
Control board, encoder interface.
Definition IMotor.h:24
yarp::dev::IPWMControlRaw
Interface for controlling an axis, by sending directly a PWM reference signal to a motor.
Definition IPWMControl.h:84
yarp::dev::IPidControlRaw
Interface for a generic control board device implementing a PID controller.
Definition IPidControl.h:27
yarp::dev::IPositionControlRaw
Interface for a generic control board device implementing position control in encoder coordinates.
Definition IPositionControl.h:25
yarp::dev::IPositionDirectRaw
Interface for a generic control board device implementing position control in encoder coordinates.
Definition IPositionDirect.h:113
yarp::dev::ITorqueControlRaw
Interface for control boards implementing torque control.
Definition ITorqueControl.h:139
yarp::dev::IVelocityControlRaw
Interface for control boards implementig velocity control in encoder coordinates.
Definition IVelocityControl.h:24
yarp::dev::IVelocityDirectRaw
Interface for control boards implementing direct velocity control.
Definition IVelocityDirect.h:25
yarp::dev::IVirtualAnalogSensorRaw
A generic interface to a virtual sensors.
Definition IVirtualAnalogSensor.h:77
yarp::dev::ImplementControlLimits
class ImplementControlLimits; class StubImplControlLimitsRaw;
Definition ImplementControlLimits.h:25
yarp::dev::ImplementInteractionMode
Interface settings the way the robot interacts with the environment: basic interaction types are Stif...
Definition ImplementInteractionMode.h:32
yarp::dev::ImplementPositionControl
Default implementation of the IPositionControl interface.
Definition ImplementPositionControl.h:30
yarp::dev::ImplementPositionDirect
Default implementation of the IPositionDirect interface.
Definition ImplementPositionDirect.h:30
yarp::dev::Pid
Contains the parameters for a PID.
Definition ControlBoardPid.h:24
yarp::os::PeriodicThread
An abstraction for a periodic thread.
Definition PeriodicThread.h:27
yarp::os::Searchable
A base class for nested structures that can be searched.
Definition Searchable.h:31
yarp::dev::PidControlTypeEnum
PidControlTypeEnum
Definition PidEnums.h:15
ImpedanceParameters::limits
ImpedanceLimits limits
Definition FakeMotionControl.h:70