43 double m_final_reference;
44 double m_current_value;
81 std::chrono::milliseconds controller_period) = 0;
102 double p_computeTrajectory();
103 double p_computeTrajectoryStep();
104 bool p_abortTrajectory(
double limit);
111 std::chrono::milliseconds controller_period);
131 double m_computed_reference_velocity;
133 double p_computeTrajectoryStep();
140 std::chrono::milliseconds controller_period);
159 double m_trajectory_coeff_c1;
160 double m_trajectory_coeff_c2;
161 double m_trajectory_coeff_c3;
169 double p_computeTrajectory();
170 double p_computeTrajectoryStep();
171 bool p_abortTrajectory(
double limit);
173 double p_compute_p5f(
double t);
174 double p_compute_p5f_vel(
double t);
175 double p_compute_current_vel();
182 std::chrono::milliseconds controller_period);
202 return std::make_unique<MinJerkTrajectoryGenerator>();
204 return std::make_unique<ConstSpeedTrajectoryGenerator>();
206 return std::make_unique<TrapezoidalSpeedTrajectoryGenerator>();
208 yError() <<
"Trajectory type not supported";
@ TRAJECTORY_TYPE_TRAP_SPEED
@ TRAJECTORY_TYPE_CONST_SPEED
@ TRAJECTORY_TYPE_MIN_JERK
bool initTrajectory(double current_pos, double final_pos, double speed, double acceleration, std::chrono::milliseconds controller_period)
virtual ~ConstSpeedTrajectoryGenerator()
ConstSpeedTrajectoryGenerator()
TrajectoryType getTrajectoryType() override
double computeTrajectory() override
bool abortTrajectory(double limit) override
double computeTrajectoryStep() override
bool initTrajectory(double current_pos, double final_pos, double speed, double acceleration, std::chrono::milliseconds controller_period)
TrajectoryType getTrajectoryType() override
MinJerkTrajectoryGenerator()
double computeTrajectoryStep() override
virtual ~MinJerkTrajectoryGenerator()
bool abortTrajectory(double limit) override
double computeTrajectory() override
void setReference(double ref, double step)
static std::unique_ptr< TrajectoryGenerator > create(TrajectoryType type)
virtual ~TrajectoryGenerator()
virtual double computeTrajectory()=0
bool m_trajectory_complete
virtual bool abortTrajectory(double limit)=0
double m_controllerPeriodMilliseconds
double m_computed_reference
virtual double computeTrajectoryStep()=0
bool setLimits(double min, double max)
virtual TrajectoryType getTrajectoryType()=0
virtual bool initTrajectory(double current_pos, double final_pos, double speed, double acceleration, std::chrono::milliseconds controller_period)=0
TrapezoidalSpeedTrajectoryGenerator()
bool abortTrajectory(double limit) override
double computeTrajectoryStep() override
bool initTrajectory(double current_pos, double final_pos, double speed, double acceleration, std::chrono::milliseconds controller_period)
double computeTrajectory() override
virtual ~TrapezoidalSpeedTrajectoryGenerator()
TrajectoryType getTrajectoryType() override
void modifyDuration(double expireTime)