const matrix::Vector3f & _position
vehicle position (dependency injection)
matrix::Vector3f _end
End point of the straight line.
matrix::Vector3f _start
Start point of the straight line.
void setLineFromTo(const matrix::Vector3f &start, const matrix::Vector3f &end)
float _speed
desired speed between accelerating and decelerating
bool isEndReached()
Check if the end was reached.
StraightLine(const matrix::Vector3f &pos)
void setSpeed(const float &speed)
bool end_reached
Flag to lock further movement when end is reached.
void generateSetpoints(matrix::Vector3f &position_setpoint, matrix::Vector3f &velocity_setpoint)
Generate setpoints on a straight line according to parameters.