/***************************************************************************
 *   Copyright (C) 2020 by Federico Amedeo Izzo IU2NUO,                    *
 *                         Niccolò Izzo IU2KIN,                            *
 *                         Frederik Saraci IU2NRO,                         *
 *                         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 <stdio.h>
#include <string.h>
#include <state.h>
#include <battery.h>
#include <hwconfig.h>
#include <interfaces/platform.h>
#include <interfaces/nvmem.h>

void state_init()
{
    /*
     * TODO: Read current state parameters from hardware,
     * or initialize them to sane defaults
     */
    state.radioStateUpdated = true;
#ifdef HAS_RTC
    state.time = rtc_getTime();
    state_applyTimezone();
#endif
    state.v_bat = platform_getVbat();
    state.charge = battery_getCharge(state.v_bat);
    state.rssi = rtx_getRssi();

    // Set default channel index (it is 1-based)
    state.channel_index = 1;
    // Read VFO channel from Flash storage
    if(nvm_readVFOChannelData(&state.channel) != 0)
    {
        // If the read fails set VFO channel default settings
        state.channel.mode = FM;
        state.channel.bandwidth = BW_25;
        state.channel.power = 1.0;
        state.channel.rx_frequency = 430000000;
        state.channel.tx_frequency = 430000000;
        state.channel.fm.rxToneEn = 0;
        state.channel.fm.rxTone = 2; // 71.9Hz
        state.channel.fm.txToneEn = 1;
        state.channel.fm.txTone = 2; // 71.9Hz
    }
    state.zone_enabled = false;
    state.rtxStatus = RTX_OFF;
#ifdef HAS_ABSOLUTE_KNOB // If the radio has an absolute position knob
    state.sqlLevel = platform_getChSelector() - 1;
#else
    state.sqlLevel = 3;
#endif
    state.voxLevel = 0;

    state.emergency = false;

    // Read settings from flash memory
    int valid = nvm_readSettings(&state.settings);
    // Settings in flash memory were not valid, restoring default settings
    if(valid != 0)
    {
        state.settings = default_settings;
        nvm_writeSettings(&state.settings);
    }
}

void state_terminate()
{
    // Write settings to flash memory
    nvm_writeSettings(&state.settings);
}

void state_applyTimezone()
{
    if(state.time.hour + state.settings.utc_timezone >= 24)
    {
        state.time.hour = state.time.hour - 24 + state.settings.utc_timezone;
    }
    else if(state.time.hour + state.settings.utc_timezone < 0)
    {
        state.time.hour = state.time.hour + 24 + state.settings.utc_timezone;
    }
    else
    {
        state.time.hour += state.settings.utc_timezone;
    }
}