/***************************************************************************
 *   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 "emulator.h"
#include <pthread.h>
#include <unistd.h>
#include <stdio.h>
#include <stdlib.h>

void systemBootstrap();

int CLIMenu() {
    int choice = 0;
    printf("Select the value to change:\n");
    printf("1 -> RSSI\n");
    printf("2 -> Vbat\n");
    printf("3 -> Mic Level\n");
    printf("4 -> Volume Level\n");
    printf("5 -> Channel selector\n");
    printf("6 -> Toggle PTT\n");
    printf("7 -> Print current state\n");
    printf("8 -> Exit\n");
    printf("> ");
    do {
        scanf("%d", &choice);
    } while (choice < 1 || choice > 7);
    printf("\e[1;1H\e[2J");
    return choice;
}

void *updateValue(float *curr_value) {
    printf("Current value: %f\n", *curr_value);
    printf("New value: \n");
    scanf("%f", curr_value);
}

void *printState() {
    printf("\nCurrent state\n");
    printf("RSSI   : %f\n", Radio_State.RSSI);
    printf("Battery: %f\n", Radio_State.Vbat);
    printf("Mic    : %f\n", Radio_State.micLevel);
    printf("Volume : %f\n", Radio_State.volumeLevel);
    printf("Channel: %f\n", Radio_State.chSelector);
    printf("PTT    : %s\n\n", Radio_State.PttStatus ? "true" : "false");

}

void *startRadio() {
    systemBootstrap();
}
//void *startGUI();

void *startCLIMenu() {
    int choice;
    do {
        choice = CLIMenu();
        switch (choice) {
            case VAL_RSSI:
                updateValue(&Radio_State.RSSI);
                break;
            case VAL_BAT:
                updateValue(&Radio_State.Vbat);
                break;
            case VAL_MIC:
                updateValue(&Radio_State.micLevel);
                break;
            case VAL_VOL:
                updateValue(&Radio_State.volumeLevel);
                break;
            case VAL_CH:
                updateValue(&Radio_State.chSelector);
                break;
            case VAL_PTT:
                Radio_State.PttStatus = Radio_State.PttStatus ? false : true;
                break;
            case PRINT_STATE:
                printState();
                break;
            default:
                continue;
        }
    } while (choice != EXIT);
    printf("exiting\n");
    SDL_Quit();
    SDL_DestroyWindow(window);
    exit(0);
};


int emulator_main() {
    Radio_State = (radio_state){12, 7, 3, 4, 1, false};

    pthread_t gui_thread, cli_thread, radio_thread;
    int err1, err2;

    err1 = pthread_create(&cli_thread, NULL, startCLIMenu, NULL);
    //err2 = pthread_create(&gui_thread, NULL, startGUI, NULL);

    if (err1) {
        printf("An error occurred starting the threads: %d, %d\n", err1, err2);
        return 1;
    }
    //pthread_join(gui_thread, NULL);
    pthread_create(&radio_thread, NULL, startRadio, NULL);
    pthread_join(cli_thread, NULL);


    printf("73\n");
    return 0;
}


void *entry() {
    __asm__(
    "xorl %ebp, %ebp\n\t"
    "mov %RDX, %R9\n\t"

    #ifdef __ILP32__
    "mov (%rsp), %esi\n\t"
    "add $4, %esp\n\t"
    #else
    "popq %rsi\n\t"
    #endif
    "mov %RSP, %RDX\n\t"
    "and  $~15, %RSP\n\t"
    "pushq %rax\n\t"
    "pushq %rsp\n\t"
    "mov __libc_csu_fini@GOTPCREL(%rip), %R8\n\t"
    "mov __libc_csu_init@GOTPCREL(%rip), %RCX\n\t"
    "mov emulator_main@GOTPCREL(%rip), %RDI\n\t"
    "call *__libc_start_main@GOTPCREL(%rip)\n\t"
    "hlt\n\t");
}