ruckig 0.17.3

Instantaneous Motion Generation for Robots and Machines.
Documentation 
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33

use ruckig::{InputParameter, OutputParameter, Result, Ruckig};

fn main() {
    // Create instances: Ruckig as well as input and output parameters
    let mut ruckig = Ruckig::new_direct(3, 0.01); // DoFs, control cycle
    let mut input = InputParameter::new(3);
    let mut output = OutputParameter::new_direct(3);

    // Set input parameters
    input.current_position = vec![0.0, 0.0, 0.5];
    input.current_velocity = vec![0.0, -2.2, -0.5];
    input.current_acceleration = vec![0.0, 2.5, -0.5];

    input.target_position = vec![5.0, -2.0, -3.5];
    input.target_velocity = vec![0.0, -0.5, -2.0];
    input.target_acceleration = vec![0.0, 0.0, 0.5];

    input.max_velocity = vec![3.0, 1.0, 3.0];
    input.max_acceleration = vec![3.0, 2.0, 1.0];
    input.max_jerk = vec![4.0, 3.0, 2.0];

    // Generate the trajectory within the control loop
    println!("t | position");
    while ruckig.update(&mut input, &mut output) == Result::Working {
        let pos: Vec<String> = output.new_position.iter().map(|x| format!("{x:.4}")).collect();
        println!("{:.4} | [{}]", output.time, pos.join(", "));

        output.pass_to_input(&mut input);
    }

    println!("Trajectory duration: {} [s].", output.trajectory().get_duration());
}