28 cte_a0v_deg,
double, cte_a0v, cfg, sSection);
30 cte_a0w_deg,
double, cte_a0w, cfg, sSection);
36 const int WN = 25, WV = 30;
41 "Contant for vel profile [deg].");
44 "Contant for omega profile [deg].");
53 str, 100,
"CPTG_DiffDrive_alpha,av=%udeg,aw=%udeg",
65 in >> cte_a0v >> cte_a0w;
82 out << cte_a0v << cte_a0w;
88 float alpha,
float t,
float x,
float y,
float phi,
float&
v,
float&
w)
const 93 float At_a =
alpha - phi;
96 while (At_a < -
M_PI) At_a += (float)
M_2PI;
98 v = V_MAX * exp(-
square(At_a / cte_a0v));
99 w = W_MAX * (-0.5f + (1 / (1 + exp(-At_a / cte_a0w))));
virtual void saveToConfigFile(mrpt::utils::CConfigFileBase &cfg, const std::string &sSection) const override
This method saves the options to a ".ini"-like file or memory-stored string list. ...
GLclampf GLclampf GLclampf alpha
Classes for serialization, sockets, ini-file manipulation, streams, list of properties-values, timewatch, extensions to STL.
double DEG2RAD(const double x)
Degrees to radians.
This namespace provides a OS-independent interface to many useful functions: filenames manipulation...
#define MRPT_LOAD_HERE_CONFIG_VAR_DEGREES_NO_DEFAULT( variableName, variableType, targetVariable, configFileObject, sectionNameStr)
void internal_readFromStream(mrpt::utils::CStream &in) override
GLubyte GLubyte GLubyte GLubyte w
This class allows loading and storing values and vectors of different types from a configuration text...
T square(const T x)
Inline function for the square of a number.
void loadDefaultParams() override
Loads a set of default parameters; provided exclusively for the PTG-configurator tool.
This base class is used to provide a unified interface to files,memory buffers,..Please see the deriv...
This is the base class for any user-defined PTG.
virtual void loadFromConfigFile(const mrpt::utils::CConfigFileBase &cfg, const std::string &sSection) override
Possible values in "params" (those in CParameterizedTrajectoryGenerator, which is called internally...
double RAD2DEG(const double x)
Radians to degrees.
#define MRPT_UNUSED_PARAM(a)
Can be used to avoid "not used parameters" warnings from the compiler.
#define MRPT_THROW_UNKNOWN_SERIALIZATION_VERSION(__V)
For use in CSerializable implementations.
IMPLEMENTS_SERIALIZABLE(CPTG_DiffDrive_alpha, CParameterizedTrajectoryGenerator, mrpt::nav) void CPTG_DiffDrive_alpha
virtual void saveToConfigFile(mrpt::utils::CConfigFileBase &cfg, const std::string &sSection) const override
This method saves the options to a ".ini"-like file or memory-stored string list. ...
GLsizei const GLchar ** string
This is the global namespace for all Mobile Robot Programming Toolkit (MRPT) libraries.
void write(const std::string §ion, const std::string &name, enum_t value, const int name_padding_width=-1, const int value_padding_width=-1, const std::string &comment=std::string())
The "a(symptotic)-alpha PTG", as named in PTG papers.
void ptgDiffDriveSteeringFunction(float alpha, float t, float x, float y, float phi, float &v, float &w) const override
The main method to be implemented in derived classes: it defines the differential-driven differential...
void internal_writeToStream(mrpt::utils::CStream &out) const override
virtual void loadDefaultParams() override
Loads a set of default parameters; provided exclusively for the PTG-configurator tool.
std::string getDescription() const override
Gets a short textual description of the PTG and its parameters.
int sprintf(char *buf, size_t bufSize, const char *format,...) noexcept MRPT_printf_format_check(3
An OS-independent version of sprintf (Notice the bufSize param, which may be ignored in some compiler...
virtual void loadFromConfigFile(const mrpt::utils::CConfigFileBase &cfg, const std::string &sSection) override
Possible values in "params" (those in CParameterizedTrajectoryGenerator, which is called internally...
void writeToStream(mrpt::utils::CStream &out, int *getVersion) const override
Introduces a pure virtual method responsible for writing to a CStream.
void readFromStream(mrpt::utils::CStream &in, int version) override
Introduces a pure virtual method responsible for loading from a CStream This can not be used directly...