/***************************************************************************
 *   Copyright (C) 2020 by Federico Amedeo Izzo IU2NUO,                    *
 *                         Niccolò Izzo IU2KIN,                            *
 *                         Silvano Seva IU2KWO                             *
 *                                                                         *
 *   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 3 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, see <http://www.gnu.org/licenses/>   *
 ***************************************************************************/

#include <interfaces/gps.h>
#include <gps.h>
#include <minmea.h>
#include <stdio.h>
#include <state.h>
#include <strings.h>

/**
 * This function parses a GPS NMEA sentence and updates radio state
 */
void gps_taskFunc(char *line, __attribute__((unused)) int len, state_t *state)
{
    switch (minmea_sentence_id(line, false)) {
        case MINMEA_SENTENCE_RMC:
        {
            struct minmea_sentence_rmc frame;
            if (minmea_parse_rmc(&frame, line)) {
                state->gps_data.latitude = minmea_tocoord(&frame.latitude);
                state->gps_data.longitude = minmea_tocoord(&frame.longitude);
                state->gps_data.timestamp.hour = frame.time.hours;
                state->gps_data.timestamp.minute = frame.time.minutes;
                state->gps_data.timestamp.second = frame.time.seconds;
                state->gps_data.timestamp.day = 0;
                state->gps_data.timestamp.date = frame.date.day;
                state->gps_data.timestamp.month = frame.date.month;
                state->gps_data.timestamp.year = frame.date.year;
            }
            // Synchronize RTC with GPS UTC clock
            if(state->settings.gps_set_time)
                rtc_setTime(state->gps_data.timestamp);
        } break;

        case MINMEA_SENTENCE_GGA:
        {
            struct minmea_sentence_gga frame;
            if (minmea_parse_gga(&frame, line))
            {
                state->gps_data.fix_quality = frame.fix_quality;
                state->gps_data.satellites_tracked = frame.satellites_tracked;
                state->gps_data.altitude = minmea_tofloat(&frame.altitude);
            }
        } break;

        case MINMEA_SENTENCE_GSA:
        {
            state->gps_data.active_sats = 0;
            struct minmea_sentence_gsa frame;
            if (minmea_parse_gsa(&frame, line))
            {
                state->gps_data.fix_type = frame.fix_type;
                for (int i = 0; i < 12; i++)
                {
                    if (frame.sats[i] != 0)
                    {
                        state->gps_data.active_sats |= 1 << (frame.sats[i] - 1);
                    }
                }
            }
        } break;

        case MINMEA_SENTENCE_GSV:
        {
            struct minmea_sentence_gsv frame;
            if (minmea_parse_gsv(&frame, line))
            {
                state->gps_data.satellites_in_view = frame.total_sats; 
                for (int i = 0; i < 4; i++)
                {
                    int index = 4 * (frame.msg_nr - 1) + i;
                    state->gps_data.satellites[index].id = frame.sats[i].nr;
                    state->gps_data.satellites[index].elevation = frame.sats[i].elevation;
                    state->gps_data.satellites[index].azimuth = frame.sats[i].azimuth;
                    state->gps_data.satellites[index].snr = frame.sats[i].snr;
                }
                // Zero out unused satellite slots
                if (frame.msg_nr == frame.total_msgs && frame.total_msgs < 3)
                    bzero(&state->gps_data.satellites[4 * frame.msg_nr],
                          sizeof(sat_t) * 12 - frame.total_msgs * 4);
            }
        } break;

        case MINMEA_SENTENCE_VTG:
        {
            struct minmea_sentence_vtg frame;
            if (minmea_parse_vtg(&frame, line)) {
                state->gps_data.speed = minmea_tofloat(&frame.speed_kph);
                state->gps_data.tmg_mag = minmea_tofloat(&frame.magnetic_track_degrees);
                state->gps_data.tmg_true = minmea_tofloat(&frame.true_track_degrees);
            }
        } break;

        // Ignore this message as we take data from RMC
        case MINMEA_SENTENCE_GLL: break;

        // These messages are never sent by the Jumpstar JS-M710 Module
        case MINMEA_SENTENCE_GST: break;
        case MINMEA_SENTENCE_ZDA: break;

        // Error handling
        case MINMEA_INVALID: break;
        case MINMEA_UNKNOWN: break;
    }
}