continuous_path_finder.h

#pragma once
 
 
#include "base/path_finder.h"
#include "base/node_grid_path_finder.h"
#include "one_direction_sync_path_finder.h"
#include "one_direction_ordered_path_finder.h"
#include "multirobot_path_finder.h"
 
class ContinuousPathFinder : public bmpf::PathFinder {
public:
 
    ContinuousPathFinder(
            const std::shared_ptr<bmpf::Scene> &scene, bool showTrace,
            unsigned int maxOpenSetSize, int gridSize, unsigned int maxNodeCnt, int checkCnt,
            int threadCnt = 1
    ) : PathFinder(scene, showTrace, threadCnt),
        _checkCnt(checkCnt), _maxOpenSetSize(maxOpenSetSize), _maxNodeCnt(maxNodeCnt),
        _gridSize(gridSize) {
        _ready = true;
    };
 
    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
    );
 
protected:
    unsigned int _maxNodeCnt;
    unsigned int _maxOpenSetSize;
    int _gridSize;
    int _checkCnt;
    std::shared_ptr<ContinuousPathFinder> _localPathFinder;
    std::shared_ptr<MultiRobotPathFinder> _globalPathFinder;
};