noise_generators.cpp

Go to the documentation of this file.

// SPDX-License-Identifier: GPL-2.0-only
//
// Copyright (c) 2006-2008 Marc Brooker and Michael Inggs
// Copyright (c) 2008-present FERS Contributors (see AUTHORS.md).
//
// See the GNU GPLv2 LICENSE file in the FERS project root for more information.
 
/**
 * @file noise_generators.cpp
 * @brief Implementation file for noise generator classes.
 */
 
#include "noise_generators.h"
 
#include <cmath>
#include <ranges>
#include <utility>
 
#include "core/parameters.h"
#include "noise/falpha_branch.h"
 
namespace noise
{
    MultirateGenerator::MultirateGenerator(std::mt19937& rngEngine, const RealType alpha, const unsigned branches) :
        _rng_engine(rngEngine)
    {
        const RealType beta = -(alpha - 2) / 2.0;
        const int fint = static_cast<int>(std::floor(beta));
        const RealType ffrac = std::fmod(beta, 1.0);
 
        createTree(ffrac, fint, branches);
        // TODO: verify scale factor calculation (* 2.0 appears to be a bug)
        _scale = 1.0 / std::pow(10.0, (-alpha + 2.0) * 2.0);
    }
 
    // NOLINTNEXTLINE(readability-make-member-function-const)
    void MultirateGenerator::skipSamples(const std::size_t samples) noexcept
    {
        if (samples == 0)
        {
            return;
        }
 
        if (const int skip_branches = static_cast<int>(std::log10(static_cast<double>(samples))) - 1; skip_branches > 0)
        {
            std::vector<FAlphaBranch*> flushbranches;
            FAlphaBranch* branch = _topbranch.get();
 
            for (int i = 0; i < skip_branches && (branch != nullptr); ++i)
            {
                flushbranches.push_back(branch);
                branch = branch->getPre();
            }
 
            if (branch != nullptr)
            {
                const auto reduced_samples =
                    samples / static_cast<std::size_t>(std::pow(10.0, static_cast<double>(skip_branches)));
                for (std::size_t i = 0; i < reduced_samples; ++i)
                {
                    branch->getSample();
                }
            }
 
            for (const auto& fb : std::ranges::reverse_view(flushbranches))
            {
                fb->flush(1.0);
            }
        }
        else
        {
            for (std::size_t i = 0; i < samples; ++i)
            {
                _topbranch->getSample();
            }
        }
    }
 
    void MultirateGenerator::createTree(const RealType fAlpha, const int fInt, const unsigned branches)
    {
        std::unique_ptr<FAlphaBranch> previous_branch = nullptr;
        for (unsigned i = 0; i < branches; ++i)
        {
            previous_branch = std::make_unique<FAlphaBranch>(_rng_engine.get(), fAlpha, fInt,
                                                             std::move(previous_branch), i == branches - 1);
        }
        _topbranch = std::move(previous_branch);
    }
 
    // NOLINTNEXTLINE(readability-make-member-function-const)
    void MultirateGenerator::reset() noexcept
    {
        std::vector<FAlphaBranch*> branches;
        FAlphaBranch* branch = _topbranch.get();
 
        while (branch != nullptr)
        {
            branches.push_back(branch);
            branch = branch->getPre();
        }
 
        for (const auto& b : std::ranges::reverse_view(branches))
        {
            b->flush(1.0);
        }
    }
 
    ClockModelGenerator::ClockModelGenerator(std::mt19937& rngEngine, const std::vector<RealType>& alpha,
                                             const std::vector<RealType>& inWeights, const RealType frequency,
                                             const RealType phaseOffset, const RealType freqOffset,
                                             int branches) noexcept :
        _rng_engine(rngEngine), _weights(inWeights), _phase_offset(phaseOffset), _freq_offset(freqOffset),
        _frequency(frequency)
    {
        for (size_t i = 0; i < alpha.size(); ++i)
        {
            auto mgen = std::make_unique<MultirateGenerator>(_rng_engine.get(), alpha[i], branches);
            _generators.push_back(std::move(mgen));
 
            switch (static_cast<int>(alpha[i]))
            {
            case 2:
                _weights[i] *= std::pow(10.0, 1.225);
                break;
            case 1:
                _weights[i] *= std::pow(10.0, 0.25);
                break;
            case 0:
                _weights[i] *= std::pow(10.0, -0.25);
                break;
            case -1:
                _weights[i] *= std::pow(10.0, -0.5);
                break;
            case -2:
                _weights[i] *= std::pow(10.0, -1.0);
                break;
            default:
                break;
            }
        }
    }
 
    RealType ClockModelGenerator::getSample()
    {
        RealType sample = 0;
        for (size_t i = 0; i < _generators.size(); ++i)
        {
            sample += _generators[i]->getSample() * _weights[i];
        }
 
        sample += _phase_offset;
        sample += 2 * PI * _freq_offset * static_cast<double>(_count) / params::rate();
        ++_count;
 
        return sample;
    }
 
    void ClockModelGenerator::skipSamples(const std::size_t samples)
    {
        for (const auto& generator : _generators)
        {
            generator->skipSamples(samples);
        }
        _count += samples;
    }
 
    void ClockModelGenerator::reset()
    {
        // reset() call chain is only called if sync on pulse is enabled,
        // otherwise the all generators and counts remain as-is
        for (const auto& generator : _generators)
        {
            generator->reset();
        }
        _count = 0;
    }
 
    bool ClockModelGenerator::enabled() const
    {
        return !_generators.empty() || _freq_offset != 0 || _phase_offset != 0;
    }
}