Detailed Description

A PTG for circular paths.

Definition at line 40 of file CPTG6.h.

#include <mrpt/reactivenav/CPTG6.h>

Inheritance diagram for mrpt::reactivenav::CPTG6:

Public Types
typedef std::map< uint16_t, float >	TCollisionCell
	A list of all the pairs (alpha,distance) such as the robot collides at that cell.

Public Member Functions
	CPTG6 (const TParameters< double > &params)
	Constructor: possible values in "params", those of CParameterizedTrajectoryGenerator plus:

void	lambdaFunction (float x, float y, int &out_k, float &out_d)
	The lambda function.

std::string	getDescription () const
	Gets a short textual description of the PTG and its parameters.

bool	PTG_IsIntoDomain (float x, float y)
	To be implemented in derived classes:

void	PTG_Generator (float alfa, float t, float x, float y, float phi, float &v, float &w)
	The main method to be implemented in derived classes.

void	simulateTrajectories (uint16_t alfaValuesCount, float max_time, float max_dist, unsigned int max_n, float diferencial_t, float min_dist, float out_max_acc_v=NULL, float out_max_acc_w=NULL)
	The main method: solves the diferential equation to generate a family of parametrical trajectories.

void	directionToMotionCommand (uint16_t k, float &out_v, float &out_w)
	Converts an "alfa" value (into the discrete set) into a feasible motion command.

size_t	getAlfaValuesCount ()

size_t	getPointsCountInCPath_k (uint16_t k)

void	getCPointWhen_d_Is (float d, uint16_t k, float &x, float &y, float &phi, float &t, float v=NULL, float w=NULL)

float	GetCPathPoint_x (uint16_t k, int n)

float	GetCPathPoint_y (uint16_t k, int n)

float	GetCPathPoint_phi (uint16_t k, int n)

float	GetCPathPoint_t (uint16_t k, int n)

float	GetCPathPoint_d (uint16_t k, int n)

float	GetCPathPoint_v (uint16_t k, int n)

float	GetCPathPoint_w (uint16_t k, int n)

void	allocMemForVerticesData (int nVertices)

void	setVertex_xy (uint16_t k, int n, int m, float x, float y)

float	getVertex_x (uint16_t k, int n, int m)

float	getVertex_y (uint16_t k, int n, int m)

float *	getVertixesArray_x (uint16_t k, int n)

float *	getVertixesArray_y (uint16_t k, int n)

unsigned int	getVertixesCount ()

float	getMax_V ()

float	getMax_W ()

float	getMax_V_inTPSpace ()

float	index2alfa (uint16_t k)
	Alfa value for the discrete corresponding value.

uint16_t	alfa2index (float alfa)
	Discrete index value for the corresponding alfa value.

void	debugDumpInFiles (int nPT)
	Dump PTG trajectories in files in directory "./PTGs/".

bool	SaveColGridsToFile (const std::string &filename)

bool	LoadColGridsFromFile (const std::string &filename)

Static Public Member Functions
static CParameterizedTrajectoryGenerator *	CreatePTG (const TParameters< double > &params)
	The class factory for creating a PTG from a list of parameters "params".

Public Attributes
CColisionGrid	m_collisionGrid
	The collision grid.

float	refDistance

Protected Types
typedef std::vector< TCPoint >	TCPointVector

Protected Member Functions
void	initializeCollisionsGrid (float refDistance, float resolution)
	Initialized the collision grid with the given size and resolution.

void	FreeMemory ()
	Free all the memory buffers:

Protected Attributes
float	cte_a0v

float	cte_a0w

float	V_MAX

float	W_MAX

float	TAU

float	DELAY

float	turningRadiusReference

CDynamicGrid < TCellForLambdaFunction >	m_lambdaFunctionOptimizer
	This grid will contain indexes data for speeding-up the default, brute-force lambda function.

float	maxV_inTPSpace

bool	flag1

bool	flag2

unsigned int	alfaValuesCount
	The number of discrete values for ALFA between -PI and +PI.

std::vector< TCPointVector >	CPoints

std::vector< vector_float >	vertexPoints_x
	The shape of the robot along the trajectories:

std::vector< vector_float >	vertexPoints_y

int	nVertices

Member Typedef Documentation

typedef std::map<uint16_t,float> mrpt::reactivenav::CParameterizedTrajectoryGenerator::TCollisionCell

inherited

A list of all the pairs (alpha,distance) such as the robot collides at that cell.

map key (uint16_t) -> alpha value (k)
- map value (float) -> the MINIMUM distance (d), in meters, associated with that "k".

Definition at line 185 of file CParameterizedTrajectoryGenerator.h.

typedef std::vector<TCPoint> mrpt::reactivenav::CParameterizedTrajectoryGenerator::TCPointVector

protectedinherited

Definition at line 290 of file CParameterizedTrajectoryGenerator.h.

Constructor & Destructor Documentation

mrpt::reactivenav::CPTG6::CPTG6 ( const TParameters< double > & params )

Constructor: possible values in "params", those of CParameterizedTrajectoryGenerator plus:

cte_a0v, cte_a0w: Parameters of this PTG

Member Function Documentation

uint16_t mrpt::reactivenav::CParameterizedTrajectoryGenerator::alfa2index ( float alfa )

inlineinherited

Discrete index value for the corresponding alfa value.

See Also: index2alfa

Definition at line 170 of file CParameterizedTrajectoryGenerator.h.

References M_2PI, and M_PI.

void mrpt::reactivenav::CParameterizedTrajectoryGenerator::allocMemForVerticesData ( int nVertices )

inherited

static CParameterizedTrajectoryGenerator* mrpt::reactivenav::CParameterizedTrajectoryGenerator::CreatePTG ( const TParameters< double > & params )

staticinherited

The class factory for creating a PTG from a list of parameters "params".

Possible values in "params" are:

"PTG_type": It's an integer number such as "1" -> CPTG1, "2"-> CPTG2, etc...
Those explained in CParameterizedTrajectoryGenerator::CParameterizedTrajectoryGenerator
Those explained in the specific PTG being created (e.g. CPTG1, CPTG2, etc...)

Exceptions

std::logic_error On invalid or missing parameters.

void mrpt::reactivenav::CParameterizedTrajectoryGenerator::debugDumpInFiles ( int nPT )

inherited

Dump PTG trajectories in files in directory "./PTGs/".

void mrpt::reactivenav::CParameterizedTrajectoryGenerator::directionToMotionCommand	(	uint16_t	k,
		float &	out_v,
		float &	out_w
	)

inherited

Converts an "alfa" value (into the discrete set) into a feasible motion command.

void mrpt::reactivenav::CParameterizedTrajectoryGenerator::FreeMemory ( )

protectedinherited

Free all the memory buffers:

size_t mrpt::reactivenav::CParameterizedTrajectoryGenerator::getAlfaValuesCount ( )

inlineinherited

Definition at line 106 of file CParameterizedTrajectoryGenerator.h.

float mrpt::reactivenav::CParameterizedTrajectoryGenerator::GetCPathPoint_d	(	uint16_t	k,
		int	n
	)

inlineinherited

Definition at line 115 of file CParameterizedTrajectoryGenerator.h.

float mrpt::reactivenav::CParameterizedTrajectoryGenerator::GetCPathPoint_phi	(	uint16_t	k,
		int	n
	)

inlineinherited

Definition at line 113 of file CParameterizedTrajectoryGenerator.h.

float mrpt::reactivenav::CParameterizedTrajectoryGenerator::GetCPathPoint_t	(	uint16_t	k,
		int	n
	)

inlineinherited

Definition at line 114 of file CParameterizedTrajectoryGenerator.h.

float mrpt::reactivenav::CParameterizedTrajectoryGenerator::GetCPathPoint_v	(	uint16_t	k,
		int	n
	)

inlineinherited

Definition at line 116 of file CParameterizedTrajectoryGenerator.h.

float mrpt::reactivenav::CParameterizedTrajectoryGenerator::GetCPathPoint_w	(	uint16_t	k,
		int	n
	)

inlineinherited

Definition at line 117 of file CParameterizedTrajectoryGenerator.h.

float mrpt::reactivenav::CParameterizedTrajectoryGenerator::GetCPathPoint_x	(	uint16_t	k,
		int	n
	)

inlineinherited

Definition at line 111 of file CParameterizedTrajectoryGenerator.h.

float mrpt::reactivenav::CParameterizedTrajectoryGenerator::GetCPathPoint_y	(	uint16_t	k,
		int	n
	)

inlineinherited

Definition at line 112 of file CParameterizedTrajectoryGenerator.h.

void mrpt::reactivenav::CParameterizedTrajectoryGenerator::getCPointWhen_d_Is	(	float	d,
		uint16_t	k,
		float &	x,
		float &	y,
		float &	phi,
		float &	t,
		float *	v = `NULL`,
		float *	w = `NULL`
	)

inherited

std::string mrpt::reactivenav::CPTG6::getDescription ( ) const

virtual

Gets a short textual description of the PTG and its parameters.

Implements mrpt::reactivenav::CParameterizedTrajectoryGenerator.

float mrpt::reactivenav::CParameterizedTrajectoryGenerator::getMax_V ( )

inlineinherited

Definition at line 155 of file CParameterizedTrajectoryGenerator.h.

float mrpt::reactivenav::CParameterizedTrajectoryGenerator::getMax_V_inTPSpace ( )

inlineinherited

Definition at line 157 of file CParameterizedTrajectoryGenerator.h.

float mrpt::reactivenav::CParameterizedTrajectoryGenerator::getMax_W ( )

inlineinherited

Definition at line 156 of file CParameterizedTrajectoryGenerator.h.

size_t mrpt::reactivenav::CParameterizedTrajectoryGenerator::getPointsCountInCPath_k ( uint16_t k )

inlineinherited

Definition at line 107 of file CParameterizedTrajectoryGenerator.h.

float mrpt::reactivenav::CParameterizedTrajectoryGenerator::getVertex_x	(	uint16_t	k,
		int	n,
		int	m
	)

inlineinherited

Definition at line 127 of file CParameterizedTrajectoryGenerator.h.

float mrpt::reactivenav::CParameterizedTrajectoryGenerator::getVertex_y	(	uint16_t	k,
		int	n,
		int	m
	)

inlineinherited

Definition at line 134 of file CParameterizedTrajectoryGenerator.h.

float* mrpt::reactivenav::CParameterizedTrajectoryGenerator::getVertixesArray_x	(	uint16_t	k,
		int	n
	)

inlineinherited

Definition at line 141 of file CParameterizedTrajectoryGenerator.h.

float* mrpt::reactivenav::CParameterizedTrajectoryGenerator::getVertixesArray_y	(	uint16_t	k,
		int	n
	)

inlineinherited

Definition at line 147 of file CParameterizedTrajectoryGenerator.h.

unsigned int mrpt::reactivenav::CParameterizedTrajectoryGenerator::getVertixesCount ( )

inlineinherited

Definition at line 153 of file CParameterizedTrajectoryGenerator.h.

float mrpt::reactivenav::CParameterizedTrajectoryGenerator::index2alfa ( uint16_t k )

inlineinherited

Alfa value for the discrete corresponding value.

See Also: alfa2index

Definition at line 162 of file CParameterizedTrajectoryGenerator.h.

References M_PI.

void mrpt::reactivenav::CParameterizedTrajectoryGenerator::initializeCollisionsGrid	(	float	refDistance,
		float	resolution
	)

protectedinherited

Initialized the collision grid with the given size and resolution.

void mrpt::reactivenav::CPTG6::lambdaFunction	(	float	x,
		float	y,
		int &	out_k,
		float &	out_d
	)

virtual

The lambda function.

Reimplemented from mrpt::reactivenav::CParameterizedTrajectoryGenerator.

bool mrpt::reactivenav::CParameterizedTrajectoryGenerator::LoadColGridsFromFile ( const std::string & filename )

inherited

void mrpt::reactivenav::CPTG6::PTG_Generator	(	float	alfa,
		float	t,
		float	x,
		float	y,
		float	phi,
		float &	v,
		float &	w
	)

virtual

The main method to be implemented in derived classes.

Implements mrpt::reactivenav::CParameterizedTrajectoryGenerator.

bool mrpt::reactivenav::CPTG6::PTG_IsIntoDomain	(	float	x,
		float	y
	)

virtual

To be implemented in derived classes:

Implements mrpt::reactivenav::CParameterizedTrajectoryGenerator.

bool mrpt::reactivenav::CParameterizedTrajectoryGenerator::SaveColGridsToFile ( const std::string & filename )

inherited

void mrpt::reactivenav::CParameterizedTrajectoryGenerator::setVertex_xy	(	uint16_t	k,
		int	n,
		int	m,
		float	x,
		float	y
	)

inlineinherited

Definition at line 121 of file CParameterizedTrajectoryGenerator.h.

void mrpt::reactivenav::CParameterizedTrajectoryGenerator::simulateTrajectories	(	uint16_t	alfaValuesCount,
		float	max_time,
		float	max_dist,
		unsigned int	max_n,
		float	diferencial_t,
		float	min_dist,
		float *	out_max_acc_v = `NULL`,
		float *	out_max_acc_w = `NULL`
	)