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
34
35
36
37
38
39
40
41
42
43
44
45
46
47

#pragma once

#include <array>
#include <random>
#include <type_traits>

#include <ruckig/utils.hpp>


template<size_t DOFs, class T>
class Randomizer {
    template<class U> using Vector = ruckig::StandardVector<U, DOFs>;

    std::default_random_engine gen;
    T dist;
    std::uniform_real_distribution<double> uniform_dist;

public:
    explicit Randomizer() { }
    explicit Randomizer(T dist, int local_seed): dist(dist), uniform_dist(std::uniform_real_distribution<double>(0.0, 1.0)) {
        gen.seed(local_seed);
    }

    void fill(Vector<double>& input) {
        for (size_t dof = 0; dof < input.size(); ++dof) {
            input[dof] = dist(gen);
        }
    }

    void fill_or_zero(Vector<double>& input, double p) {
        for (size_t dof = 0; dof < input.size(); ++dof) {
            input[dof] = uniform_dist(gen) < p ? dist(gen) : 0.0;
        }
    }

    void fill(Vector<double>& input, const Vector<double>& offset) {
        for (size_t dof = 0; dof < input.size(); ++dof) {
            input[dof] = dist(gen) + std::abs(offset[dof]);
        }
    }

    void fill_min(Vector<double>& input, const Vector<double>& offset) {
        for (size_t dof = 0; dof < input.size(); ++dof) {
            input[dof] = dist(gen) - std::abs(offset[dof]);
        }
    }
};