//
// Created by YY on 2020/1/20.
//

#include <pthread.h>
#include <cstdlib>
#include <cstring>
#include "virtual_rtk.h"
#include "../jni_log.h"
#include "../common/net.h"
#include "../native-lib.h"
#include "../common/apptimer.h"
#include "../defs.h"
#include "parse_gps.h"
#include "../mcu/mcu_if.h"

#define DEBUG(fmt, args...)     LOGD("<virtual_device> <%s>: " fmt, __func__, ##args)

#define PARSE_BUFF_SIZE         4096

struct vSocket {
    char domain_name[32];
    int port;
} VAddr;

static CTcpPort *ctp = NULL, *ctp2 = NULL;
static bool virtRtkIsValid = false;
static int connectCnt = 0;
static void TcpEventCallback(int stat, void *p, void *context);
static void TcpDataCallback(void *buffer, int length, void *p, void *context);

static bool virtRtkIsValid2 = false;
static int connectCnt2 = 0;
static void TcpEventCallback2(int stat, void *p, void *context);
static void TcpDataCallback2(void *buffer, int length, void *p, void *context);

static void ConnectLater(union sigval sig);

void InitVirtualDevice(const char *domain_name, int port)
{
    DEBUG("InitVirtualDevice %s: %d", domain_name, port);

    strcpy(VAddr.domain_name, domain_name);
    VAddr.port = port;

    if (ctp == NULL) {
        ctp = new CTcpPort();

        ctp->set_event_callback(TcpEventCallback, NULL);
        ctp->set_data_callback(TcpDataCallback, NULL);

        ctp->OpenTcpPort(domain_name, port);
    }

    if (ctp2 == NULL) {
        ctp2 = new CTcpPort();

        ctp2->set_event_callback(TcpEventCallback2, NULL);
        ctp2->set_data_callback(TcpDataCallback2, NULL);

        ctp2->OpenTcpPort(domain_name, port + 1);
    }
}

bool VirtualIsConnected(void)
{
    bool temp;

    do {
        temp = virtRtkIsValid;
    } while (temp != virtRtkIsValid);

    return temp;
}

bool Virtual2IsConnected(void)
{
    bool temp;

    do {
        temp = virtRtkIsValid2;
    } while (temp != virtRtkIsValid2);

    return temp;
}

static void ConnectLater(union sigval sig) {
    AppTimer_delete(ConnectLater);

    if (sig.sival_int == 1) {
        if (ctp != NULL) {
            ctp->OpenTcpPort(VAddr.domain_name, VAddr.port);
        }
    } else {
        if (ctp2 != NULL) {
            ctp2->OpenTcpPort(VAddr.domain_name, VAddr.port + 1);
        }
    }
}

static void TcpEventCallback(int stat, void *p, void *context)
{
    CTcpPort *pTcpPort = (CTcpPort *)p;

    if (stat == 0) {
        DEBUG("虚拟平台连接成功 %s: %d", pTcpPort->m_sIp.c_str(), pTcpPort->m_nPort);
        virtRtkIsValid = true;
        connectCnt = 0;
        PlayTTS("模拟器连接", NULL);
    } else {
        DEBUG("虚拟平台连接失败");
        virtRtkIsValid = false;
        connectCnt++;

        if (connectCnt < 3) {
            AppTimer_add(ConnectLater, D_SEC(3), 1);
        }
        PlayTTS("模拟器断开", NULL);
    }
}

static void TcpDataCallback(void *buffer, int length, void *p, void *context)
{
    static uint8_t RxBuf[PARSE_BUFF_SIZE];
    static int RxBufLen = 0;

    if (length > 0) {
        memcpy(RxBuf + RxBufLen, buffer, length);
        RxBufLen += length;

        const uint8_t *ptr = parseGPS(RxBuf, RxBuf + RxBufLen);

        if(ptr != RxBuf) {
            memcpy(RxBuf, ptr, RxBufLen - (ptr - RxBuf));
            RxBufLen -= ptr - RxBuf;
        } else if(RxBufLen == PARSE_BUFF_SIZE) {        //填满了，且没有一个\r，都抛弃
            DEBUG("Parse GPS error");
            RxBufLen = 0;
        }
    }
}

static void TcpEventCallback2(int stat, void *p, void *context)
{
    CTcpPort *pTcpPort = (CTcpPort *)p;

    if (stat == 0) {
        DEBUG("灯光虚拟平台连接成功 %s: %d", pTcpPort->m_sIp.c_str(), pTcpPort->m_nPort);
        virtRtkIsValid2 = true;
        connectCnt2 = 0;
        PlayTTS("灯光模拟器连接", NULL);
    } else {
        DEBUG("灯光虚拟平台连接失败");
        virtRtkIsValid2 = false;
        connectCnt2++;

        if (connectCnt2 < 3) {
            AppTimer_add(ConnectLater, D_SEC(3), 2);
        }
        PlayTTS("灯光模拟器断开", NULL);
    }
}

static void TcpDataCallback2(void *buffer, int length, void *p, void *context)
{
    static uint8_t RxBuf[PARSE_BUFF_SIZE];
    static int RxBufLen = 0;

    if (length > 0) {
        memcpy(RxBuf + RxBufLen, buffer, length);
        RxBufLen += length;

        if (RxBufLen > 0) {
            ParseMcu(RxBuf, RxBufLen);
            RxBufLen = 0;
        }
    }
}

/*
static void *VDataListenThread(void *p) {
    struct vSocket *vs = (struct vSocket *)p;

    uint8_t RxBuf[PARSE_BUFF_SIZE];

    int fds_ret;
    struct timeval tv;
    fd_set rdfds;
    fd_set exfds;

    int fd = -1;
    int RxBufLen = 0;

    connectCnt++;

    fd = ConnectTCP(vs->domain_name, vs->port);

    if (fd > 0) {
        DEBUG("虚拟平台连接成功");
        virtRtkIsValid = true;
        connectCnt = 0;
        PlayTTS("模拟器连接", NULL);
    } else {
        DEBUG("虚拟平台连接失败");
    }

    while (fd > 0) {
        tv.tv_sec = 5;
        tv.tv_usec = 0;
        FD_ZERO(&rdfds); //clean
        FD_SET(fd, &rdfds); //set

        fds_ret = select(fd + 1, &rdfds, NULL, NULL, &tv);

        if (fds_ret < 0) {
            break;
        } else if(fds_ret == 0) {
            //Occur failure(such as line disconnect)
        } else if(FD_ISSET(fd, &rdfds)) {
            int lx = ReadTCP(fd, RxBuf + RxBufLen, sizeof(RxBuf) - RxBufLen);

            if (lx < 0) {
                break;
            } else if (lx > 0) {
                RxBufLen += lx;

                const uint8_t *ptr = parseGPS(RxBuf, RxBuf + RxBufLen);

                if(ptr != RxBuf) {
                    memcpy(RxBuf, ptr, RxBufLen - (ptr - RxBuf));
                    RxBufLen -= ptr - RxBuf;
                } else if(RxBufLen == PARSE_BUFF_SIZE) {        //填满了，且没有一个\r，都抛弃
                    DEBUG("Parse GPS error");
                    RxBufLen = 0;
                }
            }
        }
    }

    if (fd > 0) {
        DEBUG("虚拟平台断开");
        DisconnectTCP(fd);
        PlayTTS("模拟器断开", NULL);
    }
    virtRtkIsValid = false;

    if (connectCnt < 5) {
        AppTimer_add(ConnectLater, D_SEC(3));
    }

    DEBUG("虚拟平台线程退出");

    pthread_exit(NULL);
}
*/