#include <continuous_path_finder.h>

Inheritance diagram for ContinuousPathFinder:

Collaboration diagram for ContinuousPathFinder:

Public Member Functions
	ContinuousPathFinder (const std::shared_ptr< bmpf::Scene > &scene, bool showTrace, unsigned int maxOpenSetSize, int gridSize, unsigned int maxNodeCnt, int checkCnt, int threadCnt=1)

void	paint (const std::vector< double > &state, bool onlyRobot) override

bool	findTick (std::vector< double > &state) override

void	prepare (const std::vector< double > &startState, const std::vector< double > &endState) override

void	buildPath () override

std::vector< std::vector< double > >	checkTask (const std::vector< double > &startState, const std::vector< double > &endState, double opacity)
	проверка задания проверка задания, возвращает пустой вектор, если маршрут можно строить штатным образом, в противном случае сохраняет в _buildedPath готовый маршрут (из стартового и конечного положений) и возвращает его More...

Public Member Functions inherited from bmpf::PathFinder
	PathFinder (const std::shared_ptr< bmpf::Scene > &scene, bool showTrace, int threadCnt=1)

std::vector< std::vector< double > >	findPath (const std::vector< double > &startState, const std::vector< double > &endState, int &errorCode)

void	updateCollider ()

bool	divideCheckPathSegment (const std::vector< double > &prevPoint, std::vector< double > nextPoint, int checkCnt)

int	divideCheckPath (std::vector< std::vector< double >> path, int checkCnt)

bool	simpleCheckPath (const std::vector< std::vector< double >> &path, double maxDist)

bool	checkState (const std::vector< double > &state)
	проверяет доступность состояния Проверяет доступность углов, после проверяет состояние на коллизии More...

std::vector< double >	getRandomState ()

std::vector< double >	getPathStateFromTM (double tm)
	получить состояние по времени две соседние точки считаются разделёнными единичным временным интервалом. More...

bool	checkCollision (const std::vector< double > &state)

void	addObjectToScene (std::string path)

void	deleteObjectFromScene (long robotNum)

double	getPathLength () const

bool	isReady () const

bool	getThreadCnt () const

void	setReady (bool ready)

std::vector< double > &	getStartState ()

std::vector< double > &	getEndState ()

int	getErrorCode () const

const std::vector< std::vector< double > > &	getBuildedPath () const

const std::shared_ptr< bmpf::Scene > &	getScene () const

const std::shared_ptr< bmpf::Collider > &	getCollider () const

double	getCalculationTimeInSeconds () const

Protected Attributes
unsigned int	_maxNodeCnt

unsigned int	_maxOpenSetSize

int	_gridSize

int	_checkCnt

std::shared_ptr< ContinuousPathFinder >	_localPathFinder

std::shared_ptr< MultiRobotPathFinder >	_globalPathFinder

Protected Attributes inherited from bmpf::PathFinder
double	_pathLength {}

int	_errorCode

std::shared_ptr< bmpf::Scene >	_scene

bool	_showTrace

std::shared_ptr< bmpf::Collider >	_collider

bool	_ready

bool	_threadCnt

std::vector< double >	_endState

std::vector< double >	_startState

std::vector< std::vector< double > >	_buildedPath

std::chrono::time_point< std::chrono::system_clock >	_startTime

double	_calculationTimeInSeconds

Additional Inherited Members
Static Public Member Functions inherited from bmpf::PathFinder
static void	infoPath (const std::vector< std::vector< double >> &path)

static Json::Value	getJSONPath (std::vector< std::vector< double >> path)

static std::vector< std::vector< double > >	getPathFromJSON (const Json::Value &json)

static void	savePathToFile (std::vector< std::vector< double >> path, const std::string &filename)

static std::vector< std::vector< double > >	loadPathFromFile (const std::string &filename, std::string &scenePath)

static std::vector< std::vector< std::vector< double > > >	loadPathsFromFile (const std::string &filename, std::string &scenePath)

static std::vector< std::vector< double > >	splitPath (std::vector< std::vector< double >> path, unsigned long partCnt)

static std::vector< double >	getPathStateFromTM (std::vector< std::vector< double >> &path, double tm)
	получить состояние по времени две соседние точки считаются разделёнными единичным временным интервалом. More...

static double	calculatePathLength (std::vector< std::vector< double >> path)

Static Public Attributes inherited from bmpf::PathFinder
static const int	NO_ERROR = -1

static const int	ERROR_CAN_NOT_FIND_PATH = 1

Detailed Description

Базовы1 класс для всех склеивающих планировщиков по тому или иному условию он определяет участки пути которые не соответствуют тем или иным требованиям и планирует новую траекторию между началом недоступного участков пути и концом, потом склеивает полученные части пути

Логика работы планировщика следующая: 1) подготовка к тактам поиска пути 2) выполнение тактов поиска пути с попутным заполнением тех или иных структур 3) если путь найден из этих структур собирается путь и сохраняется в переменную _buildedPath

Constructor & Destructor Documentation

◆ ContinuousPathFinder()

ContinuousPathFinder::ContinuousPathFinder	(	const std::shared_ptr< bmpf::Scene > &	scene,
		bool	showTrace,
		unsigned int	maxOpenSetSize,
		int	gridSize,
		unsigned int	maxNodeCnt,
		int	checkCnt,
		int	threadCnt = `1`
	)

inline

конструктор

Parameters

scene	сцена
showTrace	флаг, нужно ли выводить информацию во время поиска пути
maxOpenSetSize	максимальный размер закрытого множества
gridSize	размер сетки планирования
maxNodeCnt	максимальное кол-во нод в закрытом множестве
checkCnt	количество проверок каждого этапа пути
threadCnt	количество потоков планировщика

Member Function Documentation

◆ buildPath()

void ContinuousPathFinder::buildPath ( )

overridevirtual

построить путь, построенный путь должен быть сохранён в переменную _buildedPath

Implements bmpf::PathFinder.

◆ checkTask()

std::vector< std::vector< double > > ContinuousPathFinder::checkTask	(	const std::vector< double > &	startState,
		const std::vector< double > &	endState,
		double	opacity
	)

проверка задания проверка задания, возвращает пустой вектор, если маршрут можно строить штатным образом, в противном случае сохраняет в _buildedPath готовый маршрут (из стартового и конечного положений) и возвращает его

Parameters

startState	начальное состояние
endState	конечное состояние
opacity	точность проверки

Returns: пустой вектор, если маршрут можно строить, вектор из стартового и конечного состояний, если нельзя

◆ findTick()

bool ContinuousPathFinder::findTick ( std::vector< double > & state )

overridevirtual

такт поиска

Parameters

state текущее состояние планировщика

Returns: возвращает true, если планирование закончено

Implements bmpf::PathFinder.

◆ paint()

void ContinuousPathFinder::paint	(	const std::vector< double > &	state,
		bool	onlyRobot
	)

overridevirtual

рисование сцены планировщика

Parameters

state	состояние
onlyRobot	флаг, нужно ли рисовать только роботов

Reimplemented from bmpf::PathFinder.

◆ prepare()

void ContinuousPathFinder::prepare	(	const std::vector< double > &	startState,
		const std::vector< double > &	endState
	)

overridevirtual

подготовка к планированию

Parameters

startState	начальное состояние
endState	конечное состояние

Implements bmpf::PathFinder.

Member Data Documentation

◆ _checkCnt

int ContinuousPathFinder::_checkCnt

protected

кол-во шагов проверки этапа пути

◆ _globalPathFinder

std::shared_ptr<MultiRobotPathFinder> ContinuousPathFinder::_globalPathFinder

protected

планировщик для всей сцены с возможностью уменьшения ячейки сетки планирования

◆ _gridSize

int ContinuousPathFinder::_gridSize

protected

количество ячеек сетки планирования вдоль каждой из координат

◆ _localPathFinder

std::shared_ptr<ContinuousPathFinder> ContinuousPathFinder::_localPathFinder

protected

планировщик для всей сцены

◆ _maxNodeCnt

unsigned int ContinuousPathFinder::_maxNodeCnt

protected

максимальное кол-во нод

◆ _maxOpenSetSize

unsigned int ContinuousPathFinder::_maxOpenSetSize

protected

максимальный размер открытого множества

The documentation for this class was generated from the following files:

project/find_path/smart_path_finding/include/continuous_path_finder.h
project/find_path/smart_path_finding/src/continuous_path_finder.cpp

Public Member Functions

Protected Attributes

Additional Inherited Members

Detailed Description

Constructor & Destructor Documentation

◆ ContinuousPathFinder()

Member Function Documentation

◆ buildPath()

◆ checkTask()

◆ findTick()

◆ paint()

◆ prepare()

Member Data Documentation

◆ _checkCnt

◆ _globalPathFinder

◆ _gridSize

◆ _localPathFinder

◆ _maxNodeCnt

◆ _maxOpenSetSize