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
22#include <mutex>
23#include "FakeMotionControl_ParamsParser.h"
24
25struct ImpedanceLimits
26{
27 double min_stiff;
28 double max_stiff;
29 double min_damp;
30 double max_damp;
31 double param_a;
32 double param_b;
33 double param_c;
34
35public:
36 ImpedanceLimits()
37 {
38 min_stiff=0;
39 max_stiff=0;
40 min_damp=0;
41 max_damp=0;
42 param_a=0;
43 param_b=0;
44 param_c=0;
45 }
46
47 double get_min_stiff()
48 {
49 return min_stiff;
50 }
51 double get_max_stiff()
52 {
53 return max_stiff;
54 }
55 double get_min_damp()
56 {
57 return min_damp;
58 }
59 double get_max_damp()
60 {
61 return max_damp;
62 }
63};
64
72
86class FakeMotionControl :
87 public FakeMotionControl_ParamsParser,
88 public yarp::dev::DeviceDriver,
89 public yarp::os::PeriodicThread,
90 public yarp::dev::IPidControlRaw,
91 public yarp::dev::IControlCalibrationRaw,
92 public yarp::dev::IAmplifierControlRaw,
93 public yarp::dev::IEncodersTimedRaw,
94 public yarp::dev::IMotorEncodersRaw,
95 public yarp::dev::IMotorRaw,
96 public yarp::dev::IPositionControlRaw,
97 public yarp::dev::IVelocityControlRaw,
98 public yarp::dev::IControlModeRaw,
99 public yarp::dev::IControlLimitsRaw,
100 public yarp::dev::IPositionDirectRaw,
101 public yarp::dev::ITorqueControlRaw,
102 public yarp::dev::ICurrentControlRaw,
103 public yarp::dev::IPWMControlRaw,
104 public yarp::dev::IImpedanceControlRaw,
105 public yarp::dev::IInteractionModeRaw,
106 public yarp::dev::IAxisInfoRaw,
107 public yarp::dev::IVirtualAnalogSensorRaw, //*
108 public yarp::dev::IJointFaultRaw,
109 public yarp::dev::ImplementControlCalibration,
110 public yarp::dev::ImplementAmplifierControl,
111 public yarp::dev::ImplementPidControl,
112 public yarp::dev::ImplementEncodersTimed,
113 public yarp::dev::ImplementPositionControl,
114 public yarp::dev::ImplementVelocityControl,
115 public yarp::dev::ImplementControlMode,
116 public yarp::dev::ImplementImpedanceControl,
117 public yarp::dev::ImplementJointFault,
118 public yarp::dev::ImplementMotorEncoders,
119 public yarp::dev::ImplementTorqueControl,
120 public yarp::dev::ImplementControlLimits,
121 public yarp::dev::ImplementPositionDirect,
122 public yarp::dev::ImplementInteractionMode,
123 public yarp::dev::ImplementCurrentControl,
124 public yarp::dev::ImplementPWMControl,
125 public yarp::dev::ImplementMotor,
126 public yarp::dev::ImplementAxisInfo,
127 public yarp::dev::ImplementVirtualAnalogSensor //*
128{
129private:
130 enum VerboseLevel
131 {
132 MUTE = 0, // only errors that prevent device from working
133 QUIET = 1, // adds errors that can cause malfunctioning
134 DEFAULT = 2, // adds warnings // DEFAULT // show noisy messages about back-compatible changes
135 CHATTY = 3, // adds info messages
136 VERBOSE = 4, // adds debug messages
137 VERY_VERBOSE = 5, // adds trace of events (shows thread running and catch if they get stuck)
138 VERY_VERY_VERBOSE = 6 // adds messages printed every cycle, so too much verbose for usage, only for deep debugging
139 };
140
141 std::recursive_mutex _mutex;
142 double _cycleTimestamp;
143 int _njoints;
144 int *_axisMap;
145 double *_angleToEncoder;
146 double *_encodersStamp;
147 double *_ampsToSensor;
148 double *_dutycycleToPWM;
149 float *_DEPRECATED_encoderconversionfactor;
150 float *_DEPRECATED_encoderconversionoffset;
151// uint8_t *_jointEncoderType; /** joint encoder type*/
152 int *_jointEncoderRes;
153 int *_rotorEncoderRes;
154// uint8_t *_rotorEncoderType; /** rotor encoder type*/
155 double *_gearbox;
156 bool *_hasHallSensor;
157 bool *_hasTempSensor;
158 bool *_hasRotorEncoder;
159 bool *_hasRotorEncoderIndex;
160 int *_rotorIndexOffset;
161 int *_motorPoles;
162 double *_rotorlimits_max;
163 double *_rotorlimits_min;
164 yarp::dev::Pid *_ppids;
165 yarp::dev::Pid *_tpids;
166 yarp::dev::Pid *_cpids;
167 yarp::dev::Pid *_vpids;
168 bool *_ppids_ena;
169 bool *_tpids_ena;
170 bool *_cpids_ena;
171 bool *_vpids_ena;
172 double *_ppids_lim;
173 double *_tpids_lim;
174 double *_cpids_lim;
175 double *_vpids_lim;
176 double *_ppids_ref;
177 double *_tpids_ref;
178 double *_cpids_ref;
179 double *_vpids_ref;
180
181 std::string *_axisName;
182 yarp::dev::JointTypeEnum *_jointType;
183// ImpedanceLimits *_impedance_limits; /** impedance limits */
184 double *_limitsMin;
185 double *_limitsMax;
186 double *_kinematic_mj;
187 //double *_currentLimits; /** current limits */
188// MotorCurrentLimits *_currentLimits;
189 double *_maxJntCmdVelocity;
190 double *_maxMotorVelocity;
191 int *_velocityShifts;
192 int *_velocityTimeout;
193 double *_kbemf;
194 double *_ktau;
195 int *_kbemf_scale;
196 int *_ktau_scale;
197 double *_viscousPos;
198 double *_viscousNeg;
199 double *_coulombPos;
200 double *_coulombNeg;
201 double *_velocityThres;
202 int * _filterType;
203 int *_torqueSensorId;
204 int *_torqueSensorChan;
205 double *_maxTorque;
206 double *_newtonsToSensor;
207 bool *checking_motiondone; /* flag telling if I'm already waiting for motion done */
208 double *_last_position_move_time;
209 double *_motorPwmLimits;
210 double *_torques;
212// ImpedanceParameters *_impedance_params; /** impedance parameters */
213
214 bool verbosewhenok;
215 bool useRawEncoderData;
216 bool _pwmIsLimited;
217 bool _torqueControlEnabled;
219 enum torqueControlUnitsType {T_MACHINE_UNITS=0, T_METRIC_UNITS=1};
220 torqueControlUnitsType _torqueControlUnits;
221
222 enum positionControlUnitsType {P_MACHINE_UNITS=0, P_METRIC_UNITS=1};
223 positionControlUnitsType _positionControlUnits;
224
225 // internal stuff
226 bool velocity_watchdog_enabled = false; //false for testing purposes. On the real robot is true.
227 bool openloop_watchdog_enabled = false; //false for testing purposes. On the real robot is true.
228 int *_controlModes = nullptr;
229 int *_hwfault_code = nullptr;
230 std::string *_hwfault_message = nullptr;
231 int *_interactMode = nullptr;
232 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.
233 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.
234 bool *_calibrated = nullptr; // Flag to know if the calibrate function has been called for the joint
235 double *_posCtrl_references = nullptr; // used for position control.
236 double *_posDir_references = nullptr; // used for position Direct control.
237 double *_ref_speeds = nullptr; // used for position control.
238 double *_command_speeds = nullptr; // used for velocity control.
239 double *_ref_accs = nullptr; // for velocity control, in position min jerk eq is used.
240 double *_ref_torques = nullptr; // for torque control.
241 double *_ref_currents = nullptr;
242
243 double *_stiffness = nullptr;
244 double *_damping = nullptr;
245 double *_force_offset = nullptr;
246
247 yarp::sig::Vector current, nominalCurrent, maxCurrent, peakCurrent;
248 yarp::sig::Vector pwm, pwmLimit, refpwm, supplyVoltage,last_velocity_command, last_pwm_command;
249 yarp::sig::Vector pos, dpos, vel, speed, acc, loc, amp;
250 double prev_time;
251 bool opened;
252
253 // debugging
254 VerboseLevel verbose;
255public:
256
257 FakeMotionControl();
258 ~FakeMotionControl();
259
260 // Device Driver
261 bool open(yarp::os::Searchable &par) override;
262 bool close() override;
263 bool fromConfig(yarp::os::Searchable &config);
264
265 virtual bool initialised();
266
270 bool alloc(int njoints);
271
275 void resizeBuffers();
276
277 bool threadInit() override;
278 void threadRelease() override;
279
281 bool setPidRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j, const yarp::dev::Pid &pid) override;
282 bool setPidsRaw(const yarp::dev::PidControlTypeEnum& pidtype,const yarp::dev::Pid *pids) override;
283 bool setPidReferenceRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j, double ref) override;
284 bool setPidReferencesRaw(const yarp::dev::PidControlTypeEnum& pidtype,const double *refs) override;
285 bool setPidErrorLimitRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j, double limit) override;
286 bool setPidErrorLimitsRaw(const yarp::dev::PidControlTypeEnum& pidtype,const double *limits) override;
287 bool getPidErrorRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j, double *err) override;
288 bool getPidErrorsRaw(const yarp::dev::PidControlTypeEnum& pidtype, double *errs) override;
289 bool getPidOutputRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j, double *out) override;
290 bool getPidOutputsRaw(const yarp::dev::PidControlTypeEnum& pidtype,double *outs) override;
291 bool getPidRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j, yarp::dev::Pid *pid) override;
292 bool getPidsRaw(const yarp::dev::PidControlTypeEnum& pidtype, yarp::dev::Pid *pids) override;
293 bool getPidReferenceRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j, double *ref) override;
294 bool getPidReferencesRaw(const yarp::dev::PidControlTypeEnum& pidtype,double *refs) override;
295 bool getPidErrorLimitRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j, double *limit) override;
296 bool getPidErrorLimitsRaw(const yarp::dev::PidControlTypeEnum& pidtype,double *limits) override;
297 bool resetPidRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j) override;
298 bool disablePidRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j) override;
299 bool enablePidRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j) override;
300 bool setPidOffsetRaw(const yarp::dev::PidControlTypeEnum& pidtype,int j, double v) override;
301 bool isPidEnabledRaw(const yarp::dev::PidControlTypeEnum& pidtype, int j, bool* enabled) override;
302
303 // POSITION CONTROL INTERFACE RAW
304 bool getAxes(int *ax) override;
305 bool positionMoveRaw(int j, double ref) override;
306 bool positionMoveRaw(const double *refs) override;
307 bool relativeMoveRaw(int j, double delta) override;
308 bool relativeMoveRaw(const double *deltas) override;
309 bool checkMotionDoneRaw(bool *flag) override;
310 bool checkMotionDoneRaw(int j, bool *flag) override;
311 bool setRefSpeedRaw(int j, double sp) override;
312 bool setRefSpeedsRaw(const double *spds) override;
313 bool setRefAccelerationRaw(int j, double acc) override;
314 bool setRefAccelerationsRaw(const double *accs) override;
315 bool getRefSpeedRaw(int j, double *ref) override;
316 bool getRefSpeedsRaw(double *spds) override;
317 bool getRefAccelerationRaw(int j, double *acc) override;
318 bool getRefAccelerationsRaw(double *accs) override;
319 bool stopRaw(int j) override;
320 bool stopRaw() override;
321
322 // Position Control2 Interface
323 bool positionMoveRaw(const int n_joint, const int *joints, const double *refs) override;
324 bool relativeMoveRaw(const int n_joint, const int *joints, const double *deltas) override;
325 bool checkMotionDoneRaw(const int n_joint, const int *joints, bool *flags) override;
326 bool setRefSpeedsRaw(const int n_joint, const int *joints, const double *spds) override;
327 bool setRefAccelerationsRaw(const int n_joint, const int *joints, const double *accs) override;
328 bool getRefSpeedsRaw(const int n_joint, const int *joints, double *spds) override;
329 bool getRefAccelerationsRaw(const int n_joint, const int *joints, double *accs) override;
330 bool stopRaw(const int n_joint, const int *joints) override;
331 bool getTargetPositionRaw(const int joint, double *ref) override;
332 bool getTargetPositionsRaw(double *refs) override;
333 bool getTargetPositionsRaw(const int n_joint, const int *joints, double *refs) override;
334
335 // Velocity control interface raw
336 bool velocityMoveRaw(int j, double sp) override;
337 bool velocityMoveRaw(const double *sp) override;
338
339 // IJointFault
340 bool getLastJointFaultRaw(int j, int& fault, std::string& message) override;
341
342 // calibration2raw
343 bool setCalibrationParametersRaw(int axis, const yarp::dev::CalibrationParameters& params) override;
344 bool calibrateAxisWithParamsRaw(int axis, unsigned int type, double p1, double p2, double p3) override;
345 bool calibrationDoneRaw(int j) override;
346
347
349
350 // ControlMode
351 bool getControlModeRaw(int j, int *v) override;
352 bool getControlModesRaw(int *v) override;
353
354 // ControlMode 2
355 bool getControlModesRaw(const int n_joint, const int *joints, int *modes) override;
356 bool setControlModeRaw(const int j, const int mode) override;
357 bool setControlModesRaw(const int n_joint, const int *joints, int *modes) override;
358 bool setControlModesRaw(int *modes) override;
359
361 bool resetEncoderRaw(int j) override;
362 bool resetEncodersRaw() override;
363 bool setEncoderRaw(int j, double val) override;
364 bool setEncodersRaw(const double *vals) override;
365 bool getEncoderRaw(int j, double *v) override;
366 bool getEncodersRaw(double *encs) override;
367 bool getEncoderSpeedRaw(int j, double *sp) override;
368 bool getEncoderSpeedsRaw(double *spds) override;
369 bool getEncoderAccelerationRaw(int j, double *spds) override;
370 bool getEncoderAccelerationsRaw(double *accs) override;
372
373 bool getEncodersTimedRaw(double *encs, double *stamps) override;
374 bool getEncoderTimedRaw(int j, double *encs, double *stamp) override;
375
377 bool getNumberOfMotorEncodersRaw(int * num) override;
378 bool resetMotorEncoderRaw(int m) override;
379 bool resetMotorEncodersRaw() override;
380 bool setMotorEncoderRaw(int m, const double val) override;
381 bool setMotorEncodersRaw(const double *vals) override;
382 bool getMotorEncoderRaw(int m, double *v) override;
383 bool getMotorEncodersRaw(double *encs) override;
384 bool getMotorEncoderSpeedRaw(int m, double *sp) override;
385 bool getMotorEncoderSpeedsRaw(double *spds) override;
386 bool getMotorEncoderAccelerationRaw(int m, double *spds) override;
387 bool getMotorEncoderAccelerationsRaw(double *accs) override;
388 bool getMotorEncodersTimedRaw(double *encs, double *stamps) override;
389 bool getMotorEncoderTimedRaw(int m, double *encs, double *stamp) override;
390 bool getMotorEncoderCountsPerRevolutionRaw(int m, double *v) override;
391 bool setMotorEncoderCountsPerRevolutionRaw(int m, const double cpr) override;
393
395 bool getAxisNameRaw(int axis, std::string& name) override;
396 bool getJointTypeRaw(int axis, yarp::dev::JointTypeEnum& type) override;
398
399 //Internal use, not exposed by YARP (yet)
400 virtual bool getRotorEncoderResolutionRaw(int m, double &rotres);
401 virtual bool getJointEncoderResolutionRaw(int m, double &jntres);
402 virtual bool getJointEncoderTypeRaw(int j, int &type);
403 virtual bool getRotorEncoderTypeRaw(int j, int &type);
404 virtual bool getKinematicMJRaw(int j, double &rotres);
405 virtual bool getHasTempSensorsRaw(int j, int& ret);
406 virtual bool getHasHallSensorRaw(int j, int& ret);
407 virtual bool getHasRotorEncoderRaw(int j, int& ret);
408 virtual bool getHasRotorEncoderIndexRaw(int j, int& ret);
409 virtual bool getMotorPolesRaw(int j, int& poles);
410 virtual bool getRotorIndexOffsetRaw(int j, double& rotorOffset);
411 virtual bool getTorqueControlFilterType(int j, int& type);
412
414 bool enableAmpRaw(int j) override;
415 bool disableAmpRaw(int j) override;
416 bool getCurrentsRaw(double *vals) override;
417 bool getCurrentRaw(int j, double *val) override;
418 bool getNominalCurrentRaw(int m, double *val) override;
419 bool setNominalCurrentRaw(int m, const double val) override;
420 bool setMaxCurrentRaw(int j, double val) override;
421 bool getMaxCurrentRaw(int j, double *val) override;
422 bool getPeakCurrentRaw(int m, double *val) override;
423 bool setPeakCurrentRaw(int m, const double val) override;
424 bool getAmpStatusRaw(int *st) override;
425 bool getAmpStatusRaw(int j, int *st) override;
426 bool getPWMRaw(int j, double* val) override;
427 bool getPWMLimitRaw(int j, double* val) override;
428 bool setPWMLimitRaw(int j, const double val) override;
429 bool getPowerSupplyVoltageRaw(int j, double* val) override;
431
432 // Limits
433 bool setLimitsRaw(int axis, double min, double max) override;
434 bool getLimitsRaw(int axis, double *min, double *max) override;
435 // Limits 2
436 bool setVelLimitsRaw(int axis, double min, double max) override;
437 bool getVelLimitsRaw(int axis, double *min, double *max) override;
438
439 // Torque control
440 bool getTorqueRaw(int j, double *t) override;
441 bool getTorquesRaw(double *t) override;
442 bool getTorqueRangeRaw(int j, double *min, double *max) override;
443 bool getTorqueRangesRaw(double *min, double *max) override;
444 bool setRefTorquesRaw(const double *t) override;
445 bool setRefTorqueRaw(int j, double t) override;
446 bool setRefTorquesRaw(const int n_joint, const int *joints, const double *t) override;
447 bool getRefTorquesRaw(double *t) override;
448 bool getRefTorqueRaw(int j, double *t) override;
449 bool getMotorTorqueParamsRaw(int j, yarp::dev::MotorTorqueParameters *params) override;
450 bool setMotorTorqueParamsRaw(int j, const yarp::dev::MotorTorqueParameters params) override;
451// int32_t getRefSpeedInTbl(uint8_t boardNum, int j, eOmeas_position_t pos) override;
452
453 // IVelocityControl interface
454 bool velocityMoveRaw(const int n_joint, const int *joints, const double *spds) override;
455 bool getRefVelocityRaw(const int joint, double *ref) override;
456 bool getRefVelocitiesRaw(double *refs) override;
457 bool getRefVelocitiesRaw(const int n_joint, const int *joints, double *refs) override;
458
459 // Impedance interface
460 bool getImpedanceRaw(int j, double *stiffness, double *damping) override;
461 bool setImpedanceRaw(int j, double stiffness, double damping) override;
462 bool setImpedanceOffsetRaw(int j, double offset) override;
463 bool getImpedanceOffsetRaw(int j, double *offset) override;
464 bool getCurrentImpedanceLimitRaw(int j, double *min_stiff, double *max_stiff, double *min_damp, double *max_damp) override;
465
466 // PositionDirect Interface
467 bool setPositionRaw(int j, double ref) override;
468 bool setPositionsRaw(const int n_joint, const int *joints, const double *refs) override;
469 bool setPositionsRaw(const double *refs) override;
470 bool getRefPositionRaw(const int joint, double *ref) override;
471 bool getRefPositionsRaw(double *refs) override;
472 bool getRefPositionsRaw(const int n_joint, const int *joints, double *refs) override;
473
474 // InteractionMode interface
475 bool getInteractionModeRaw(int j, yarp::dev::InteractionModeEnum* _mode) override;
476 bool getInteractionModesRaw(int n_joints, int *joints, yarp::dev::InteractionModeEnum* modes) override;
477 bool getInteractionModesRaw(yarp::dev::InteractionModeEnum* modes) override;
478 bool setInteractionModeRaw(int j, yarp::dev::InteractionModeEnum _mode) override;
479 bool setInteractionModesRaw(int n_joints, int *joints, yarp::dev::InteractionModeEnum* modes) override;
480 bool setInteractionModesRaw(yarp::dev::InteractionModeEnum* modes) override;
481
482 // IMotor interface
483 bool getNumberOfMotorsRaw(int * num) override;
484 bool getTemperatureRaw(int m, double* val) override;
485 bool getTemperaturesRaw(double *vals) override;
486 bool getTemperatureLimitRaw(int m, double *temp) override;
487 bool setTemperatureLimitRaw(int m, const double temp) override;
488 bool getGearboxRatioRaw(int m, double* gearbox) override;
489 bool setGearboxRatioRaw(int m, const double val) override;
490
491 // PWM interface
492 bool setRefDutyCycleRaw(int j, double v) override;
493 bool setRefDutyCyclesRaw(const double *v) override;
494 bool getRefDutyCycleRaw(int j, double *v) override;
495 bool getRefDutyCyclesRaw(double *v) override;
496 bool getDutyCycleRaw(int j, double *v) override;
497 bool getDutyCyclesRaw(double *v) override;
498
499 // Current interface
500 //bool getAxes(int *ax) override;
501 //bool getCurrentRaw(int j, double *t) override;
502 //bool getCurrentsRaw(double *t) override;
503 bool getCurrentRangeRaw(int j, double *min, double *max) override;
504 bool getCurrentRangesRaw(double *min, double *max) override;
505 bool setRefCurrentsRaw(const double *t) override;
506 bool setRefCurrentRaw(int j, double t) override;
507 bool setRefCurrentsRaw(const int n_joint, const int *joints, const double *t) override;
508 bool getRefCurrentsRaw(double *t) override;
509 bool getRefCurrentRaw(int j, double *t) override;
510
511 yarp::dev::VAS_status getVirtualAnalogSensorStatusRaw(int ch) override;
512 int getVirtualAnalogSensorChannelsRaw() override;
513 bool updateVirtualAnalogSensorMeasureRaw(yarp::sig::Vector &measure) override;
514 bool updateVirtualAnalogSensorMeasureRaw(int ch, double &measure) override;
515
516 void run() override;
517private:
518 void cleanup();
519 bool dealloc();
520
521 //bool parsePositionPidsGroup(yarp::os::Bottle& pidsGroup, yarp::dev::Pid myPid[]);
522 //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[]);
523 //bool parseImpedanceGroup_NewFormat(yarp::os::Bottle& pidsGroup, ImpedanceParameters vals[]);
524 //bool extractGroup(yarp::os::Bottle &input, yarp::os::Bottle &out, const std::string &key1, const std::string &txt, int size);
525};
526
527#endif // YARP_DEVICE_FAKE_MOTIONCONTROL
ControlBoardInterfaces.h
define control board standard interfaces
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:128
FakeMotionControl::getPowerSupplyVoltageRaw
bool getPowerSupplyVoltageRaw(int j, double *val) override
Definition FakeMotionControl.cpp:1929
FakeMotionControl::getRefSpeedRaw
bool getRefSpeedRaw(int j, double *ref) override
Get reference speed for a joint.
Definition FakeMotionControl.cpp:1365
FakeMotionControl::getHasTempSensorsRaw
virtual bool getHasTempSensorsRaw(int j, int &ret)
Definition FakeMotionControl.cpp:1990
FakeMotionControl::setRefCurrentsRaw
bool setRefCurrentsRaw(const double *t) override
Set the reference value of the currents for all motors.
Definition FakeMotionControl.cpp:2540
FakeMotionControl::setRefTorqueRaw
bool setRefTorqueRaw(int j, double t) override
Set the reference value of the torque for a given joint.
Definition FakeMotionControl.cpp:2096
FakeMotionControl::getCurrentsRaw
bool getCurrentsRaw(double *vals) override
Definition FakeMotionControl.cpp:1848
FakeMotionControl::getImpedanceOffsetRaw
bool getImpedanceOffsetRaw(int j, double *offset) override
Get current force Offset for a specific joint.
Definition FakeMotionControl.cpp:2160
FakeMotionControl::getTargetPositionRaw
bool getTargetPositionRaw(const int joint, double *ref) override
Get the last position reference for the specified axis.
Definition FakeMotionControl.cpp:2260
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:2077
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:2168
FakeMotionControl::setTemperatureLimitRaw
bool setTemperatureLimitRaw(int m, const double temp) override
Set the temperature limit for a specific motor.
Definition FakeMotionControl.cpp:2456
FakeMotionControl::getPidErrorRaw
bool getPidErrorRaw(const yarp::dev::PidControlTypeEnum &pidtype, int j, double *err) override
Get the current error for a joint.
Definition FakeMotionControl.cpp:871
FakeMotionControl::setPeakCurrentRaw
bool setPeakCurrentRaw(int m, const double val) override
Definition FakeMotionControl.cpp:1893
FakeMotionControl::velocityMoveRaw
bool velocityMoveRaw(int j, double sp) override
Start motion at a given speed, single joint.
Definition FakeMotionControl.cpp:1137
FakeMotionControl::checkMotionDoneRaw
bool checkMotionDoneRaw(bool *flag) override
Check if the current trajectory is terminated.
Definition FakeMotionControl.cpp:1284
FakeMotionControl::getMotorEncoderSpeedRaw
bool getMotorEncoderSpeedRaw(int m, double *sp) override
Read the istantaneous speed of a motor encoder.
Definition FakeMotionControl.cpp:1774
FakeMotionControl::getJointEncoderTypeRaw
virtual bool getJointEncoderTypeRaw(int j, int &type)
Definition FakeMotionControl.cpp:1975
FakeMotionControl::setRefDutyCycleRaw
bool setRefDutyCycleRaw(int j, double v) override
Sets the reference dutycycle of a single motor.
Definition FakeMotionControl.cpp:2462
FakeMotionControl::getTemperatureRaw
bool getTemperatureRaw(int m, double *val) override
Get temperature of a motor.
Definition FakeMotionControl.cpp:2435
FakeMotionControl::getEncoderAccelerationRaw
bool getEncoderAccelerationRaw(int j, double *spds) override
Read the instantaneous acceleration of an axis.
Definition FakeMotionControl.cpp:1678
FakeMotionControl::getRefAccelerationRaw
bool getRefAccelerationRaw(int j, double *acc) override
Get reference acceleration for a joint.
Definition FakeMotionControl.cpp:1377
FakeMotionControl::getMotorEncoderSpeedsRaw
bool getMotorEncoderSpeedsRaw(double *spds) override
Read the instantaneous speed of all motor encoders.
Definition FakeMotionControl.cpp:1780
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:797
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:2048
FakeMotionControl::getJointTypeRaw
bool getJointTypeRaw(int axis, yarp::dev::JointTypeEnum &type) override
Definition FakeMotionControl.cpp:2034
FakeMotionControl::setMotorEncoderRaw
bool setMotorEncoderRaw(int m, const double val) override
Set the value of the motor encoder for a given motor.
Definition FakeMotionControl.cpp:1727
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:974
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:1100
FakeMotionControl::setControlModeRaw
bool setControlModeRaw(const int j, const int mode) override
Definition FakeMotionControl.cpp:1568
FakeMotionControl::getMotorEncoderAccelerationRaw
bool getMotorEncoderAccelerationRaw(int m, double *spds) override
Read the instantaneous acceleration of a motor encoder.
Definition FakeMotionControl.cpp:1790
FakeMotionControl::open
bool open(yarp::os::Searchable &par) override
Open the DeviceDriver.
Definition FakeMotionControl.cpp:518
FakeMotionControl::getHasHallSensorRaw
virtual bool getHasHallSensorRaw(int j, int &ret)
Definition FakeMotionControl.cpp:1995
FakeMotionControl::getTemperatureLimitRaw
bool getTemperatureLimitRaw(int m, double *temp) override
Retreives the current temperature limit for a specific motor.
Definition FakeMotionControl.cpp:2451
FakeMotionControl::getNumberOfMotorsRaw
bool getNumberOfMotorsRaw(int *num) override
Get the number of available motors.
Definition FakeMotionControl.cpp:2429
FakeMotionControl::disableAmpRaw
bool disableAmpRaw(int j) override
Disable the amplifier on a specific joint.
Definition FakeMotionControl.cpp:1836
FakeMotionControl::setMotorTorqueParamsRaw
bool setMotorTorqueParamsRaw(int j, const yarp::dev::MotorTorqueParameters params) override
Set the motor parameters.
Definition FakeMotionControl.cpp:2200
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:1174
FakeMotionControl::setRefAccelerationRaw
bool setRefAccelerationRaw(int j, double acc) override
Set reference acceleration for a joint.
Definition FakeMotionControl.cpp:1322
FakeMotionControl::initialised
virtual bool initialised()
Definition FakeMotionControl.cpp:488
FakeMotionControl::setGearboxRatioRaw
bool setGearboxRatioRaw(int m, const double val) override
Set the gearbox ratio for a specific motor.
Definition FakeMotionControl.cpp:1955
FakeMotionControl::setEncodersRaw
bool setEncodersRaw(const double *vals) override
Set the value of all encoders.
Definition FakeMotionControl.cpp:1623
FakeMotionControl::getPidOutputsRaw
bool getPidOutputsRaw(const yarp::dev::PidControlTypeEnum &pidtype, double *outs) override
Get the output of the controllers (e.g.
Definition FakeMotionControl.cpp:1123
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:1078
FakeMotionControl::setRefSpeedsRaw
bool setRefSpeedsRaw(const double *spds) override
Set reference speed on all joints.
Definition FakeMotionControl.cpp:1311
FakeMotionControl::getTargetPositionsRaw
bool getTargetPositionsRaw(double *refs) override
Get the last position reference for all axes.
Definition FakeMotionControl.cpp:2279
FakeMotionControl::getRefDutyCycleRaw
bool getRefDutyCycleRaw(int j, double *v) override
Gets the last reference sent using the setRefDutyCycleRaw function.
Definition FakeMotionControl.cpp:2479
FakeMotionControl::setMotorEncoderCountsPerRevolutionRaw
bool setMotorEncoderCountsPerRevolutionRaw(int m, const double cpr) override
Sets number of counts per revolution for motor encoder m.
Definition FakeMotionControl.cpp:1737
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:861
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:939
FakeMotionControl::getNominalCurrentRaw
bool getNominalCurrentRaw(int m, double *val) override
Definition FakeMotionControl.cpp:1899
FakeMotionControl::getControlModeRaw
bool getControlModeRaw(int j, int *v) override
Definition FakeMotionControl.cpp:1537
FakeMotionControl::calibrationDoneRaw
bool calibrationDoneRaw(int j) override
Check if the calibration is terminated, on a particular joint.
Definition FakeMotionControl.cpp:1180
FakeMotionControl::threadInit
bool threadInit() override
Initialization method.
Definition FakeMotionControl.cpp:493
FakeMotionControl::getRefDutyCyclesRaw
bool getRefDutyCyclesRaw(double *v) override
Gets the last reference sent using the setRefDutyCyclesRaw function.
Definition FakeMotionControl.cpp:2485
FakeMotionControl::getRefVelocityRaw
bool getRefVelocityRaw(const int joint, double *ref) override
Get the last reference speed set by velocityMove for single joint.
Definition FakeMotionControl.cpp:2298
FakeMotionControl::getEncoderTimedRaw
bool getEncoderTimedRaw(int j, double *encs, double *stamp) override
Read the instantaneous acceleration of all axes.
Definition FakeMotionControl.cpp:1709
FakeMotionControl::disablePidRaw
bool disablePidRaw(const yarp::dev::PidControlTypeEnum &pidtype, int j) override
Disable the pid computation for a joint.
Definition FakeMotionControl.cpp:1011
FakeMotionControl::getVirtualAnalogSensorStatusRaw
yarp::dev::VAS_status getVirtualAnalogSensorStatusRaw(int ch) override
Check the status of a given channel.
Definition FakeMotionControl.cpp:2582
FakeMotionControl::getMotorEncodersRaw
bool getMotorEncodersRaw(double *encs) override
Read the position of all motor encoders.
Definition FakeMotionControl.cpp:1763
FakeMotionControl::getTorqueRangesRaw
bool getTorqueRangesRaw(double *min, double *max) override
Get the full scale of the torque sensors of all joints.
Definition FakeMotionControl.cpp:2082
FakeMotionControl::getRefCurrentsRaw
bool getRefCurrentsRaw(double *t) override
Get the reference value of the currents for all motors.
Definition FakeMotionControl.cpp:2567
FakeMotionControl::setRefDutyCyclesRaw
bool setRefDutyCyclesRaw(const double *v) override
Sets the reference dutycycle for all motors.
Definition FakeMotionControl.cpp:2470
FakeMotionControl::getEncoderSpeedRaw
bool getEncoderSpeedRaw(int j, double *sp) override
Read the instantaneous speed of an axis.
Definition FakeMotionControl.cpp:1661
FakeMotionControl::getVirtualAnalogSensorChannelsRaw
int getVirtualAnalogSensorChannelsRaw() override
Get the number of channels of the virtual sensor.
Definition FakeMotionControl.cpp:2587
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:1006
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:2529
FakeMotionControl::getEncoderRaw
bool getEncoderRaw(int j, double *v) override
Read the value of an encoder.
Definition FakeMotionControl.cpp:1638
FakeMotionControl::getPidErrorLimitsRaw
bool getPidErrorLimitsRaw(const yarp::dev::PidControlTypeEnum &pidtype, double *limits) override
Get the error limit for all controllers.
Definition FakeMotionControl.cpp:996
FakeMotionControl::enableAmpRaw
bool enableAmpRaw(int j) override
Enable the amplifier on a specific joint.
Definition FakeMotionControl.cpp:1831
FakeMotionControl::fromConfig
bool fromConfig(yarp::os::Searchable &config)
Definition FakeMotionControl.cpp:596
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:926
FakeMotionControl::getRefPositionsRaw
bool getRefPositionsRaw(double *refs) override
Get the last position reference for all axes.
Definition FakeMotionControl.cpp:2342
FakeMotionControl::getMotorTorqueParamsRaw
bool getMotorTorqueParamsRaw(int j, yarp::dev::MotorTorqueParameters *params) override
Get the motor parameters.
Definition FakeMotionControl.cpp:2177
FakeMotionControl::setControlModesRaw
bool setControlModesRaw(const int n_joint, const int *joints, int *modes) override
Definition FakeMotionControl.cpp:1587
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:1302
FakeMotionControl::getHasRotorEncoderIndexRaw
virtual bool getHasRotorEncoderIndexRaw(int j, int &ret)
Definition FakeMotionControl.cpp:2005
FakeMotionControl::updateVirtualAnalogSensorMeasureRaw
bool updateVirtualAnalogSensorMeasureRaw(yarp::sig::Vector &measure) override
Set a vector of torque values for virtual sensor.
Definition FakeMotionControl.cpp:2592
FakeMotionControl::resizeBuffers
void resizeBuffers()
Resize previously allocated buffers.
Definition FakeMotionControl.cpp:159
FakeMotionControl::threadRelease
void threadRelease() override
Release method.
Definition FakeMotionControl.cpp:514
FakeMotionControl::getAmpStatusRaw
bool getAmpStatusRaw(int *st) override
Definition FakeMotionControl.cpp:1877
FakeMotionControl::getLastJointFaultRaw
bool getLastJointFaultRaw(int j, int &fault, std::string &message) override
Definition FakeMotionControl.cpp:2607
FakeMotionControl::setImpedanceRaw
bool setImpedanceRaw(int j, double stiffness, double damping) override
Set current impedance parameters (stiffness,damping) for a specific joint.
Definition FakeMotionControl.cpp:2143
FakeMotionControl::setPWMLimitRaw
bool setPWMLimitRaw(int j, const double val) override
Definition FakeMotionControl.cpp:1923
FakeMotionControl::relativeMoveRaw
bool relativeMoveRaw(int j, double delta) override
Set relative position.
Definition FakeMotionControl.cpp:1235
FakeMotionControl::getMotorPolesRaw
virtual bool getMotorPolesRaw(int j, int &poles)
Definition FakeMotionControl.cpp:2010
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:903
FakeMotionControl::getCurrentRaw
bool getCurrentRaw(int j, double *val) override
Definition FakeMotionControl.cpp:1841
FakeMotionControl::getPeakCurrentRaw
bool getPeakCurrentRaw(int m, double *val) override
Definition FakeMotionControl.cpp:1887
FakeMotionControl::getDutyCyclesRaw
bool getDutyCyclesRaw(double *v) override
Gets the current dutycycle of the output of the amplifier (i.e.
Definition FakeMotionControl.cpp:2500
FakeMotionControl::setEncoderRaw
bool setEncoderRaw(int j, double val) override
Set the value of the encoder for a given joint.
Definition FakeMotionControl.cpp:1618
FakeMotionControl::getRefPositionRaw
bool getRefPositionRaw(const int joint, double *ref) override
Get the last position reference for the specified axis.
Definition FakeMotionControl.cpp:2324
FakeMotionControl::getLimitsRaw
bool getLimitsRaw(int axis, double *min, double *max) override
Get the software limits for a particular axis.
Definition FakeMotionControl.cpp:1943
FakeMotionControl::getRotorIndexOffsetRaw
virtual bool getRotorIndexOffsetRaw(int j, double &rotorOffset)
Definition FakeMotionControl.cpp:2015
FakeMotionControl::getVelLimitsRaw
bool getVelLimitsRaw(int axis, double *min, double *max) override
Get the software speed limits for a particular axis.
Definition FakeMotionControl.cpp:2053
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:2241
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:807
FakeMotionControl::resetEncodersRaw
bool resetEncodersRaw() override
Reset encoders.
Definition FakeMotionControl.cpp:1633
FakeMotionControl::getPWMRaw
bool getPWMRaw(int j, double *val) override
Definition FakeMotionControl.cpp:1911
FakeMotionControl::getAxisNameRaw
bool getAxisNameRaw(int axis, std::string &name) override
Definition FakeMotionControl.cpp:2020
FakeMotionControl::setCalibrationParametersRaw
bool setCalibrationParametersRaw(int axis, const yarp::dev::CalibrationParameters &params) override
Start calibration, this method is very often platform specific.
Definition FakeMotionControl.cpp:1168
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:1055
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:2364
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:2521
FakeMotionControl::stopRaw
bool stopRaw() override
Stop motion, multiple joints.
Definition FakeMotionControl.cpp:1395
FakeMotionControl::getKinematicMJRaw
virtual bool getKinematicMJRaw(int j, double &rotres)
Definition FakeMotionControl.cpp:1985
FakeMotionControl::getRefSpeedsRaw
bool getRefSpeedsRaw(double *spds) override
Get reference speed of all joints.
Definition FakeMotionControl.cpp:1371
FakeMotionControl::getRefAccelerationsRaw
bool getRefAccelerationsRaw(double *accs) override
Get reference acceleration of all joints.
Definition FakeMotionControl.cpp:1383
FakeMotionControl::getJointEncoderResolutionRaw
virtual bool getJointEncoderResolutionRaw(int m, double &jntres)
Definition FakeMotionControl.cpp:1970
FakeMotionControl::getAxes
bool getAxes(int *ax) override
Get the number of controlled axes.
Definition FakeMotionControl.cpp:1189
FakeMotionControl::setMaxCurrentRaw
bool setMaxCurrentRaw(int j, double val) override
Definition FakeMotionControl.cpp:1859
FakeMotionControl::alloc
bool alloc(int njoints)
Allocated buffers.
Definition FakeMotionControl.cpp:199
FakeMotionControl::resetMotorEncodersRaw
bool resetMotorEncodersRaw() override
Reset motor encoders.
Definition FakeMotionControl.cpp:1752
FakeMotionControl::setRefTorquesRaw
bool setRefTorquesRaw(const double *t) override
Set the reference value of the torque for all joints.
Definition FakeMotionControl.cpp:2087
FakeMotionControl::getEncodersRaw
bool getEncodersRaw(double *encs) override
Read the position of all axes.
Definition FakeMotionControl.cpp:1649
FakeMotionControl::setRefAccelerationsRaw
bool setRefAccelerationsRaw(const double *accs) override
Set reference acceleration on all joints.
Definition FakeMotionControl.cpp:1343
FakeMotionControl::getControlModesRaw
bool getControlModesRaw(int *v) override
Definition FakeMotionControl.cpp:1548
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:774
FakeMotionControl::getPWMLimitRaw
bool getPWMLimitRaw(int j, double *val) override
Definition FakeMotionControl.cpp:1917
FakeMotionControl::getRotorEncoderTypeRaw
virtual bool getRotorEncoderTypeRaw(int j, int &type)
Definition FakeMotionControl.cpp:1980
FakeMotionControl::getRefCurrentRaw
bool getRefCurrentRaw(int j, double *t) override
Get the reference value of the current for a single motor.
Definition FakeMotionControl.cpp:2576
FakeMotionControl::getDutyCycleRaw
bool getDutyCycleRaw(int j, double *v) override
Gets the current dutycycle of the output of the amplifier (i.e.
Definition FakeMotionControl.cpp:2494
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:839
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:2373
FakeMotionControl::positionMoveRaw
bool positionMoveRaw(int j, double ref) override
Set new reference point for a single axis.
Definition FakeMotionControl.cpp:1196
FakeMotionControl::getMotorEncoderCountsPerRevolutionRaw
bool getMotorEncoderCountsPerRevolutionRaw(int m, double *v) override
Gets number of counts per revolution for motor encoder m.
Definition FakeMotionControl.cpp:1742
FakeMotionControl::setImpedanceOffsetRaw
bool setImpedanceOffsetRaw(int j, double offset) override
Set current force Offset for a specific joint.
Definition FakeMotionControl.cpp:2152
FakeMotionControl::setMotorEncodersRaw
bool setMotorEncodersRaw(const double *vals) override
Set the value of all motor encoders.
Definition FakeMotionControl.cpp:1732
FakeMotionControl::getPidErrorsRaw
bool getPidErrorsRaw(const yarp::dev::PidControlTypeEnum &pidtype, double *errs) override
Get the error of all joints.
Definition FakeMotionControl.cpp:893
FakeMotionControl::getGearboxRatioRaw
bool getGearboxRatioRaw(int m, double *gearbox) override
Get the gearbox ratio for a specific motor.
Definition FakeMotionControl.cpp:1950
FakeMotionControl::getMaxCurrentRaw
bool getMaxCurrentRaw(int j, double *val) override
Returns the maximum electric current allowed for a given motor.
Definition FakeMotionControl.cpp:1865
FakeMotionControl::close
bool close() override
Close the DeviceDriver.
Definition FakeMotionControl.cpp:736
FakeMotionControl::getRefTorquesRaw
bool getRefTorquesRaw(double *t) override
Get the reference value of the torque for all joints.
Definition FakeMotionControl.cpp:2117
FakeMotionControl::setRefCurrentRaw
bool setRefCurrentRaw(int j, double t) override
Set the reference value of the current for a single motor.
Definition FakeMotionControl.cpp:2550
FakeMotionControl::getNumberOfMotorEncodersRaw
bool getNumberOfMotorEncodersRaw(int *num) override
Get the number of available motor encoders.
Definition FakeMotionControl.cpp:1721
FakeMotionControl::getPidReferencesRaw
bool getPidReferencesRaw(const yarp::dev::PidControlTypeEnum &pidtype, double *refs) override
Get the current reference of all pid controllers.
Definition FakeMotionControl.cpp:961
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:2062
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:2134
FakeMotionControl::enablePidRaw
bool enablePidRaw(const yarp::dev::PidControlTypeEnum &pidtype, int j) override
Enable the pid computation for a joint.
Definition FakeMotionControl.cpp:1033
FakeMotionControl::getRefVelocitiesRaw
bool getRefVelocitiesRaw(double *refs) override
Get the last reference speed set by velocityMove for all joints.
Definition FakeMotionControl.cpp:2304
FakeMotionControl::setPositionRaw
bool setPositionRaw(int j, double ref) override
Set new position for a single axis.
Definition FakeMotionControl.cpp:2235
FakeMotionControl::getEncoderAccelerationsRaw
bool getEncoderAccelerationsRaw(double *accs) override
Read the instantaneous acceleration of all axes.
Definition FakeMotionControl.cpp:1686
FakeMotionControl::setPidReferencesRaw
bool setPidReferencesRaw(const yarp::dev::PidControlTypeEnum &pidtype, const double *refs) override
Set the controller reference, multiple axes.
Definition FakeMotionControl.cpp:829
FakeMotionControl::getMotorEncoderRaw
bool getMotorEncoderRaw(int m, double *v) override
Read the value of a motor encoder.
Definition FakeMotionControl.cpp:1757
FakeMotionControl::getRefTorqueRaw
bool getRefTorqueRaw(int j, double *t) override
Set the reference value of the torque for a given joint.
Definition FakeMotionControl.cpp:2126
FakeMotionControl::getMotorEncoderAccelerationsRaw
bool getMotorEncoderAccelerationsRaw(double *accs) override
Read the instantaneous acceleration of all motor encoders.
Definition FakeMotionControl.cpp:1796
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:2408
FakeMotionControl::getTemperaturesRaw
bool getTemperaturesRaw(double *vals) override
Get temperature of all the motors.
Definition FakeMotionControl.cpp:2441
FakeMotionControl::resetMotorEncoderRaw
bool resetMotorEncoderRaw(int m) override
Reset motor encoder, single motor.
Definition FakeMotionControl.cpp:1747
FakeMotionControl::setNominalCurrentRaw
bool setNominalCurrentRaw(int m, const double val) override
Definition FakeMotionControl.cpp:1905
FakeMotionControl::getRotorEncoderResolutionRaw
virtual bool getRotorEncoderResolutionRaw(int m, double &rotres)
Definition FakeMotionControl.cpp:1965
FakeMotionControl::getHasRotorEncoderRaw
virtual bool getHasRotorEncoderRaw(int j, int &ret)
Definition FakeMotionControl.cpp:2000
FakeMotionControl::getMotorEncodersTimedRaw
bool getMotorEncodersTimedRaw(double *encs, double *stamps) override
Read the instantaneous position of all motor encoders.
Definition FakeMotionControl.cpp:1806
FakeMotionControl::resetEncoderRaw
bool resetEncoderRaw(int j) override
Reset encoder, single joint.
Definition FakeMotionControl.cpp:1628
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:2068
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:1937
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:2396
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:1818
FakeMotionControl::getEncodersTimedRaw
bool getEncodersTimedRaw(double *encs, double *stamps) override
Read the instantaneous acceleration of all axes.
Definition FakeMotionControl.cpp:1698
FakeMotionControl::getEncoderSpeedsRaw
bool getEncoderSpeedsRaw(double *spds) override
Read the instantaneous acceleration of an axis.
Definition FakeMotionControl.cpp:1668
FakeMotionControl::getTorqueControlFilterType
virtual bool getTorqueControlFilterType(int j, int &type)
Definition FakeMotionControl.cpp:1960
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::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::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:69