#include <ruckig/ruckig.hpp>
#include "plotter.hpp"
using namespace ruckig;
int main() {
Ruckig<3> ruckig(0.01); InputParameter<3> input;
OutputParameter<3> output;
input.control_interface = ControlInterface::Velocity;
input.current_position = {0.0, 0.0, 0.5};
input.current_velocity = {3.0, -2.2, -0.5};
input.current_acceleration = {0.0, 2.5, -0.5};
input.target_velocity = {0.0, -0.5, -1.5};
input.target_acceleration = {0.0, 0.0, 0.5};
input.max_acceleration = {3.0, 2.0, 1.0};
input.max_jerk = {6.0, 6.0, 4.0};
std::cout << "t | position" << std::endl;
while (ruckig.update(input, output) == Result::Working) {
std::cout << output.time << " | " << pretty_print(output.new_position) << std::endl;
output.pass_to_input(input);
}
std::cout << "Trajectory duration: " << output.trajectory.get_duration() << " [s]." << std::endl;
}