/*
 * Copyright (c) 2009 Steve Gribble (gribble [at] cs.washington.edu) and
 *                    Mark Liversedge (liversedge@gmail.com)
 *
 * This program is free software; you can redistribute it and/or modify it
 * under the terms of the GNU General Public License as published by the Free
 * Software Foundation; either version 2 of the License, or (at your option)
 * any later version.
 *
 * This program is distributed in the hope that it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License along
 * with this program; if not, write to the Free Software Foundation, Inc., 51
 * Franklin Street, Fifth Floor, Boston, MA  02110-1301  USA
 */

#include <stdio.h>
#include <cmath>

#include "NullController.h"
#include "RealtimeData.h"
#include "PhysicsUtility.h"

#define CORE_START 37.5
#define CORE_UPPER_LIMIT 40.0
#define CORE_LOWER_LIMIT 35.0

#define SKIN_START 35.0
#define SKIN_UPPER_LIMIT 40.0
#define SKIN_LOWER_LIMIT 30.0

#define HSI_START 2.0
#define HSI_UPPER_LIMIT 5.0
#define HSI_LOWER_LIMIT 0


NullController::NullController(TrainSidebar *parent,
                               DeviceConfiguration *dc)
  : RealtimeController(parent, dc), parent(parent), load(100),
    bicycle(NULL)
{
  //set values before start as heat
  core = 37.5;
  skin = 37.0;
  heatStrain = 2.0;
}

int NullController::start() {
  count = 0;
  bicycle.clear();
  return 0;
}

int NullController::stop() {
  return 0;
}

int NullController::pause() {
  return 0;
}

int NullController::restart() {
    count = 0;
    bicycle.clear();
    return 0;
}

bool NullController::find() {
    return true;
}

void NullController::setMode(int ) {
    restart();
}

void NullController::getRealtimeData(RealtimeData &rtData) {
    rtData.setName((char *)"Null");
    rtData.setWatts(load + ((rand()%25)-15)); // for testing virtual power
    rtData.setLoad(load);
    rtData.setLRBalance(50 + ((rand()%20)-10)); // for testing LRBalance widget

    // Compute speed from principles and randomized power instead of randomizing it independantly.
    // This makes it easier to eyeball rlv behavior and test gpx tools using rides generated by
    // simulation.
    BicycleSimState newState(rtData);
    SpeedDistance ret = bicycle.SampleSpeed(newState);
    rtData.setSpeed(ret.v);
    rtData.setCadence(85 + ((rand()%10)-5));
    rtData.setHr(145 + ((rand()%3)-2));
    rtData.setHb(35 + ((rand()%30)), 11 + (double(rand()%100) * 0.01f));

    rtData.setCoreTemp(core, skin, heatStrain);

    //randomize robot temp for testing
    core += ((rand()%5) - 2) /10.0;
    if(core < CORE_LOWER_LIMIT)
      core = CORE_START;
    if(core > CORE_UPPER_LIMIT)
      core = CORE_START;
    skin += ((rand()%5) - 2) /10.0;
    if(skin < SKIN_LOWER_LIMIT)
      skin = SKIN_START;
    if(skin > SKIN_UPPER_LIMIT)
      skin = SKIN_START;
    heatStrain += ((rand()%3) - 1) /10.0;
    if(heatStrain < HSI_LOWER_LIMIT)
      heatStrain = HSI_START;
    if(heatStrain > HSI_UPPER_LIMIT)
      heatStrain = HSI_START;

    processRealtimeData(rtData); // for testing virtual power etc

    // generate an R-R data signal based upon 60bpm +/- 2bpm
    if (count++%5 == 0) {

        // emit measurementTime 1/1024s plus a little randomness, incremental beat count, bpm of 60 +/- 2
        uint16_t m = (beats * 1024) + (rand()%50);
        uint8_t b = ++beats;
        uint8_t bpm =60+(rand()%2);

        //qDebug()<<"rrdata:"<<m<<b<<bpm;
        emit rrData(m, b, bpm);
    }
}

void NullController::pushRealtimeData(RealtimeData &) {
}
