SwitchingAlgorithm.cpp

/**
 * @license    BSD 3-Clause
 * @copyright  microHAL
 * @version    $Id$
 * @brief
 *
 * @authors    kamil
 * created on: 05-11-2017
 * last modification: 05-11-2017
 *
 * @copyright Copyright (c) 2017, microHAL
 * All rights reserved.
 *
 * Redistribution and use in source and binary forms, with or without modification, are permitted provided that the following conditions are met:
 *
 *     1. Redistributions of source code must retain the above copyright notice, this list of conditions and the following disclaimer.
 *     2. Redistributions in binary form must reproduce the above copyright notice, this list of conditions and the following disclaimer in the
 *        documentation and/or other materials provided with the distribution.
 *     3. Neither the name of the copyright holder nor the names of its contributors may be used to endorse or promote products derived from this
 *        software without specific prior written permission.
 *
 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO,
 * THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER
 * OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
 * LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
 * EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
 */

/* **************************************************************************************************************************************************
 * INCLUDES
 */

#include "SwitchingAlgorithm.h"

#include <chrono>

#include "Instance.h"

void SwitchingAlgorithm::Update(std::valarray<float> aRSSI) {
    aRSSI = 1.0f - std::pow(1.0f - aRSSI, 3);  // Steep response for small rssi values
    auto max = std::max_element(std::begin(aRSSI), std::end(aRSSI));
    auto maxIdx = std::distance(std::begin(aRSSI), max);
    auto timeNow = std::chrono::system_clock::now();

    if (maxIdx != mCurrentSwitch && ((*max - aRSSI[mCurrentSwitch]) > mCriticalTreshold || (timeNow - mLastSwitchTime) > 1s)) {
        mLastSwitchTime = timeNow;
        mCurrentSwitch = maxIdx;
        Instance::GetWorkQueue().Add({UpdateChannel, WorkRequestArg{.Channel = mCurrentSwitch}});
    }
}