Vector.hpp

Go to the documentation of this file.

// This file is part of INSTINCT, the INS Toolkit for Integrated
// Navigation Concepts and Training by the Institute of Navigation of
// the University of Stuttgart, Germany.
//
// This Source Code Form is subject to the terms of the Mozilla Public
// License, v. 2.0. If a copy of the MPL was not distributed with this
// file, You can obtain one at https://mozilla.org/MPL/2.0/.
 
 
#pragma once
 
#include <vector>
 
namespace NAV
{
 
template<typename T>
void move(std::vector<T>& v, size_t sourceIdx, size_t targetIdx)
{
    if (sourceIdx > targetIdx)
    {
        std::rotate(v.rend() - static_cast<int64_t>(sourceIdx) - 1,
                    v.rend() - static_cast<int64_t>(sourceIdx), v.rend() - static_cast<int64_t>(targetIdx));
    }
    else
    {
        std::rotate(v.begin() + static_cast<int64_t>(sourceIdx),
                    v.begin() + static_cast<int64_t>(sourceIdx) + 1, v.begin() + static_cast<int64_t>(targetIdx) + 1);
    }
}
 
template<typename Scalar>
std::vector<Scalar> genRangeVector(Scalar start, Scalar stepSize, Scalar end)
{
    std::vector<Scalar> container;
    container.reserve(static_cast<size_t>(std::ceil((end - start) / stepSize)));
 
    while (start < end)
    {
        container.push_back(start);
        start += stepSize;
    }
 
    return container;
};
 
} // namespace NAV