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>
#include <span>
 
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;
};

template<typename T>
[[nodiscard]] bool operator==(const std::vector<T>& lhs, std::span<const T> rhs)
{
    if (lhs.size() != rhs.size()) { return false; }
    for (size_t i = 0; i < lhs.size(); i++)
    {
        if (lhs[i] != rhs[i]) { return false; }
    }
    return true;
}

template<typename T>
[[nodiscard]] bool operator==(std::span<const T> lhs, const std::vector<T>& rhs)
{
    return rhs == lhs;
}
 
} // namespace NAV