Class CControlledRateTimer

Inheritance Relationships

Base Type

Class Documentation

class CControlledRateTimer : public mrpt::system::COutputLogger

A class for calling sleep() in a loop, such that the amount of sleep time will be computed to make the loop run at the desired rate (in Hz). This class implements a PI controller on top of a vanilla CRateTimer object, ensuring a high accuracy in achieved execution rates. Note that this is done by setting a slightly-higher rate (“control action”) to the internal CRateTimer, such that the error between the user-provided expected rate and the actual measured rate (low-pass filtered) is decreased by means of a PI controller.

Note that rates higher than a few kHz are not attainable in all CPUs and/or kernel versions. Find below some graphs illustrating how this class tries to achieve a constant setpoint rate (given by the user), reacting to changes in the setpoint values:

../../output_staging/generated/doxygen/xml/CControlledRateTimer_example.png

This graphs is generated with the example:

system_control_rate_timer_example --rate1 2000.0 --rate2 4000.0

All the parameters for the PI controller and low-pass filter (rate estimator) are settable by the user to adapt them to specific needs.

Note

Control law by Francisco Jose Mañas Alvarez

Note

[New in MRPT 2.0.4]

Main API

CControlledRateTimer(const double rate_hz = 1.0)

Ctor: specifies the desired rate (Hz)

virtual ~CControlledRateTimer() = default

Dtor

CControlledRateTimer(const CControlledRateTimer&) = delete
CControlledRateTimer &operator=(const CControlledRateTimer&) = delete
CControlledRateTimer(CControlledRateTimer&&) = delete
CControlledRateTimer &operator=(CControlledRateTimer&&) = delete
void setRate(const double rate_hz)

Changes the object loop rate (Hz)

bool sleep()

Sleeps for some time, such as the return of this method is 1/rate (seconds) after the return of the previous call.

Returns:

false if the rate could not be achieved (“we are already late”), true if all went right.

PI control parameters

inline double controllerParam_Kp() const

PI controller Kp parameter [default=1.0]

inline void controllerParam_Kp(double v)
inline double controllerParam_Ti() const

PI controller Ti parameter [default=0.0194]

inline void controllerParam_Ti(double v)
inline double lowPassParam_a0() const

Low-pass filter a0 value [default=0.9]: estimation = a0*input + (1-a0)*former_estimation

inline void lowPassParam_a0(double v)
inline double followErrorRatioToRaiseWarning() const

Get/set ratio threshold for issuing a warning (via COutputLogger interface) if the achieved rate is not this close to the set-point [Default=0.2, =20%]

inline void followErrorRatioToRaiseWarning(double v)
inline double actualControlledRate() const

Gets the actual controller output: the rate (Hz) of the internal CRateTimer object.

inline double estimatedRate() const

Gets the latest estimated run rate (Hz), which comes from actual period measurement, low-pass filtered.

inline double estimatedRateRaw() const

Last actual execution rate measured (Hz), without low-pass filtering