src/controllers/controllerUtil.cpp

#include <defines.h>

#include <controllers/controllerUtil.h>

#include <sstream>
#include <iostream>

#include <dtUtil/log.h>

using namespace std;

//ControllerUtil::ControllerUtil() {
//}

float ControllerUtil::computeAverage(HistoryMap* histMap, float currentValue) {
        float sum = 0.0, result = histMap->defaultValue;
        int cnt = 0;
        std::vector<float>* hist = &(histMap->history);
        (*hist)[histMap->currentValueIndex] = currentValue;

#ifdef WITH_DEBUGGING
        std::ostringstream msg; msg.clear(); msg.str("");
        msg << "History: " ;
#endif
        for (int x = 0; x < histMap->historySize; ++x) {
#ifdef WITH_DEBUGGING
                msg.flags( ios::right);
                msg.width(3);
                msg << int(hist->at(x));
#endif
                if((*hist)[x] != histMap->defaultValue) {
                        int weight = (histMap->historySize-(histMap->currentValueIndex-x))%(histMap->historySize);
                        if(weight == 0) weight = histMap->historySize;
                        sum += (*hist)[x]*weight;
                        cnt += weight;
#ifdef WITH_DEBUGGING
                        msg << "*" << weight << ",";
#endif
                } else {
#ifdef WITH_DEBUGGING
                        msg << "*0?,";
#endif
                }
        }

        histMap->currentValueIndex = (histMap->currentValueIndex+1)%histMap->historySize;
        if(cnt > 0) result = sum / cnt;

#ifdef WITH_DEBUGGING
        msg << " becomes (" << sum << "/" << cnt << "): ";
        msg.precision(2); msg.width(6); msg.flags(ios::right);
        msg << fixed << result;
        LOG_DEBUG(msg.str());
#endif
        return result;
}

void ControllerUtil::print(HistoryMap *histMap) {
        std::vector<float>* hist = &(histMap->history);
        std::ostringstream msg;
        msg.clear(); msg.str(""); msg.flush();
        msg << "History [" << histMap->historySize << "]: " ;

        for (int x = 0; x < histMap->historySize; ++x) {
                msg << int(hist->at(x)) << ",";
        }
        LOG_INFO(msg.str());
}

int ControllerUtil::computeAverageClassification(HistoryMap* histMap, float currentValue) {
        std::vector<float>* hist = &(histMap->history);
        (*hist)[histMap->currentValueIndex] = currentValue;
//      int energyCount[4] = {0,0,0,0};

        std::vector<int> energyCount;
        int histogram_size = 2;
        energyCount.reserve(histogram_size);

        for (int x = 0; x < histogram_size; ++x) energyCount[x] = 0;

        int maxCount = 0;
        int maxValue = 0;
        print(histMap);

        std::ostringstream msg;
        msg.clear(); msg.str(""); msg.flush();
        msg << "Energy count [" << histogram_size << "]: ";
        for (int x = 0; x < histogram_size; ++x) {
                msg << energyCount[x] << ",";
                if(energyCount[x] > maxCount) {
                        maxCount = energyCount[x];
                        maxValue = x-1;
                }
        }
        LOG_DEBUG(msg.str());
        histMap->currentValueIndex = (histMap->currentValueIndex+1)%histMap->historySize;
        return maxValue;
}

---