InterpolatingAnglePlanner.hpp

#ifndef KINEMATICS_INTERPOLATINGANGLEPLANNER_HPP
#define KINEMATICS_INTERPOLATINGANGLEPLANNER_HPP

#include "Planner.hpp"
#include <Kinematics/Matrix.hpp>

namespace HLR
{
namespace Kinematics
{
namespace Planners
{
class InterpolatingAnglePlanner : public Planner
{
public:
    ~InterpolatingAnglePlanner() override = default;

    InterpolatingAnglePlanner(const InterpolatingAnglePlanner& p) = delete;

    InterpolatingAnglePlanner(InterpolatingAnglePlanner&& p) = delete;

    InterpolatingAnglePlanner& operator=(const InterpolatingAnglePlanner& p) =
        delete;

    InterpolatingAnglePlanner& operator=(InterpolatingAnglePlanner&& p) =
        delete;

    InterpolatingAnglePlanner(double max_step_size);

    const std::optional<std::vector<Matrix<double, 5, 1>>> get_path(
        const Matrix<double, 5, 1>& current_state,
        const Matrix<double, 3, 1>& target_pos) const override;

private:
    double max_step_size;
};
}
}
}
#endif