/*
 * nmeaInfo.cpp
 *
 *  Created on: Oct 21, 2014
 *      Author: Alan Aguilar Sologuren
 */

#include "utils.h"
#include "nmeaInfo.h"

nmeaInfo::nmeaInfo() {
	// TODO Auto-generated constructor stub

}

nmeaInfo::~nmeaInfo() {
	// TODO Auto-generated destructor stub
}

void nmeaInfo::code_init_INFO()
{

    code_time_now();
    sig = NMEA_SIG_BAD;
    fix = NMEA_FIX_BAD;
}

static void nmeaInfo::code_time_now() {
    time_t lt;
    struct tm *tt;

    time(&lt);
    tt = gmtime(&lt);

    utc.year = tt->tm_year;
    utc.mon = tt->tm_mon;
    utc.day = tt->tm_mday;
    utc.hour = tt->tm_hour;
    utc.min = tt->tm_min;
    utc.sec = tt->tm_sec;
    utc.hsec = 0;
}

/**
 * \brief Convert position from INFO to radians position
 */
void nmeaInfo::code_info2pos(nmeaPOS *pos) {
    pos->lat = code_ndeg2radian(lat);
    pos->lon = code_ndeg2radian(lon);
}

/**
 * \brief Convert radians position to INFOs position
 */
void nmeaInfo::code_pos2info(const nmeaPOS *pos) {
    lat = code_radian2ndeg(pos->lat);
    lon = code_radian2ndeg(pos->lon);
}



/*
 * NOISE generator
 */

int nmeaInfo::nmea_igen_noise_init()
{
    return 1;
}

int nmeaInfo::nmea_igen_noise_loop()
{
    int it;
    int in_use;

    sig = (int)nmea_random(1, 3);
    PDOP = nmea_random(0, 9);
    HDOP = nmea_random(0, 9);
    VDOP = nmea_random(0, 9);
    fix = (int)nmea_random(2, 3);
    lat = nmea_random(0, 100);
    lon = nmea_random(0, 100);
    speed = nmea_random(0, 100);
    direction = nmea_random(0, 360);
    declination = nmea_random(0, 360);
    elv = (int)nmea_random(-100, 100);

    satinfo.inuse = 0;
    satinfo.inview = 0;

    for(it = 0; it < 12; ++it)
    {
        satinfo.sat[it].id = it;
        satinfo.sat[it].in_use = in_use = (int)nmea_random(0, 3);
        satinfo.sat[it].elv = (int)nmea_random(0, 90);
        satinfo.sat[it].azimuth = (int)nmea_random(0, 359);
        satinfo.sat[it].sig = (int)(in_use?nmea_random(40, 99):nmea_random(0, 40));

        if(in_use)
            satinfo.inuse++;
        if(satinfo.sat[it].sig > 0)
            satinfo.inview++;
    }

    return 1;
}

int nmeaInfo::nmea_igen_noise_reset()
{
    return 1;
}

/*
 * STATIC generator
 */

int nmeaInfo::nmea_igen_static_loop()
{
	code_time_now();
    return 1;
};

int nmeaInfo::nmea_igen_static_reset()
{
    satinfo.inuse = 4;
    satinfo.inview = 4;

    satinfo.sat[0].id = 1;
    satinfo.sat[0].in_use = 1;
    satinfo.sat[0].elv = 50;
    satinfo.sat[0].azimuth = 0;
    satinfo.sat[0].sig = 99;

    satinfo.sat[1].id = 2;
    satinfo.sat[1].in_use = 1;
    satinfo.sat[1].elv = 50;
    satinfo.sat[1].azimuth = 90;
    satinfo.sat[1].sig = 99;

    satinfo.sat[2].id = 3;
    satinfo.sat[2].in_use = 1;
    satinfo.sat[2].elv = 50;
    satinfo.sat[2].azimuth = 180;
    satinfo.sat[2].sig = 99;

    satinfo.sat[3].id = 4;
    satinfo.sat[3].in_use = 1;
    satinfo.sat[3].elv = 50;
    satinfo.sat[3].azimuth = 270;
    satinfo.sat[3].sig = 99;

    return 1;
}

int nmeaInfo::nmea_igen_static_init()
{
    sig = 3;
    fix = 3;

    nmea_igen_static_reset();

    return 1;
}

/*
 * SAT_ROTATE generator
 */

int nmeaInfo::nmea_igen_rotate_loop()
{
    int it;
    int count = satinfo.inview;
    double deg = 360 / (count?count:1);
    double srt = (count?(satinfo.sat[0].azimuth):0) + 5;

    code_time_now();

    for(it = 0; it < count; ++it)
    {
        satinfo.sat[it].azimuth =
            (int)((srt >= 360)?srt - 360:srt);
        srt += deg;
    }

    return 1;
};

int nmeaInfo::nmea_igen_rotate_reset()
{
    int it;
    double deg = 360 / 8;
    double srt = 0;

    satinfo.inuse = 8;
    satinfo.inview = 8;

    for(it = 0; it < satinfo.inview; ++it)
    {
        satinfo.sat[it].id = it + 1;
        satinfo.sat[it].in_use = 1;
        satinfo.sat[it].elv = 5;
        satinfo.sat[it].azimuth = (int)srt;
        satinfo.sat[it].sig = 80;
        srt += deg;
    }

    return 1;
}

int nmeaInfo::nmea_igen_rotate_init()
{
    sig = 3;
    fix = 3;

    nmea_igen_rotate_reset();

    return 1;
}

/*
 * POS_RANDMOVE generator
 */

int nmeaInfo::nmea_igen_pos_rmove_init()
{
    sig = 3;
    fix = 3;
    direction = declination = 0;
    speed = 20;
    return 1;
}

int nmeaInfo::nmea_igen_pos_rmove_loop()
{
    nmeaPOS crd;

    direction += nmea_random(-10, 10);
    speed += nmea_random(-2, 3);

    if(direction < 0)
        direction = 359 + direction;
    if(direction > 359)
        direction -= 359;

    if(speed > 40)
        speed = 40;
    if(speed < 1)
        speed = 1;

    code_info2pos(&crd);
    code_move_horz(&crd, &crd, direction, speed / 3600);
    code_pos2info(&crd);

    declination = direction;

    return 1;
};