#include "esp32_comm.h"
#include "QDebug"

#define  DEV_GPIO2 "/dev/gpiochip2"

#define  LINES_NUM_OUT          1

#define  LINE_OFFSET0_OUT       8  //PC08

static int lines_offsets_out[LINES_NUM_OUT] = {LINE_OFFSET0_OUT};

static char ble_name[12] = {'B','L','E','-','C','1','9','P','-','0','0','1'};

static unsigned char ble_need_set = 1; //1~3--need set ; 4--normal state; 0--error


ESP32_Comm::ESP32_Comm(const char *dev, Remote_Ctrl *rctl)
{
    remoteCtrl = rctl;

    workThread = remoteCtrl->workThread;

    int ret = this->OpenDev(dev);

    if (-1 == ret)
        qDebug("Can't Open Port %s!!!\n", dev);
    else qDebug("Open Port %s OK!\n", dev);

    this->SetDevAttr(115200,8,1,'N');

    fd = this->FD;

    esp32_powerPin = new Gpio_Driver(DEV_GPIO2);
    esp32_powerPin->Gpio_Init(lines_offsets_out, LINES_NUM_OUT);

}

ESP32_Comm::~ESP32_Comm()
{

}

void ESP32_Comm::setESP32_PowerON(bool on)
{
    esp32_powerPin->Gpio_SetLevel(0,(!on));
    if(on){
        qDebug("set ESP32 Power ON.");
    }
    else{
        qDebug("set ESP32 Power OFF.");
    }
}

bool ESP32_Comm::setESP32_Name(void)
{
    bool set_ok = true;

    char rx_data[12] = {0};

    int ret = Tx_Rx_Data_ESP32(ble_name, 12, rx_data, 12);

    if(0 == ret){
        for(int n=0;n<12;n++){
            if(ble_name[n] != rx_data[n]){
                set_ok = false;
                break;
            }
        }
    }
    else{
        set_ok = false;
    }

    return set_ok;
}

void ESP32_Comm::handleRxData(void *data)
{
    FRAME_DATA *recvframe = (FRAME_DATA *)data;
    FRAME_DATA sendata;
    memset(&sendata,0x00,sizeof(sendata));

    if(remoteCtrl->processRxData(recvframe,&sendata,2)){

        quint8 *txdata = (quint8 *)(&sendata);
        /*
        tmp = txdata[3];
        txdata[3] = txdata[0];
        txdata[0] = tmp;
        tmp = txdata[2];
        txdata[2] = txdata[1];
        txdata[1] = tmp;

        sendata.CRC = CRC16::CalCRC16(&sendata,sendata.Len);
        */

        /*
        qDebug("------- write data ---------");
        for(int n=0;n<FRAMEHEAD;n++){
            qDebug("0x%X",txdata[n]);
        }
        */

        WriteDev((char *)txdata, sendata.Len);
    }
}

void ESP32_Comm::run()
{
    msleep(1000);

    quint8 devAddr = workThread->sysParamXml.dev_addr;
    ble_name[9] = devAddr/100 + '0';
    ble_name[10] = devAddr%100/10 + '0';
    ble_name[11] = devAddr%10 + '0';
    ble_need_set = 1;

    quint8 rx_data[1024] = {0};

    while(1){
        if(ble_need_set>=1 && ble_need_set<=3){
            setESP32_PowerON(false);
            sleep(1);
            setESP32_PowerON(true);
            sleep(10);

            qDebug("start to set BLE name...");
            for(int t=0;t<3;t++){
                if(setESP32_Name()){
                    qDebug("set BLE name OK...");
                    ble_need_set = 4;
                    break;
                }
                else{
                    sleep(1);
                }
            }

            if(ble_need_set<3){
                ble_need_set++;
            }
            else if(ble_need_set != 4){
                ble_need_set = 0;
            }
        }
        else if(4 == ble_need_set){
            int rxlen = ReadData_ESP32(rx_data,100);
            if(rxlen > 0){
                //测试模式
                //qDebug("rxlen=%d: rx0=0x%X,rx1=0x%X",rxlen,rx_data[0],rx_data[1]);
                //rx_data[rxlen-1] = rx_data[rxlen-1]+1;
                //WriteDev(rx_data, rxlen);
                quint8 contype = workThread->remoteState.conn_type;
                if(contype != 1){ //not net,can not work at the same time
                    handleRxData(rx_data);
                }
            }
            else{
                //char txdata[] = "Hello,I am C19P...";
                //WriteDev(txdata, sizeof(txdata));
                //msleep(2000);
            }

            quint8 addr = workThread->sysParamXml.dev_addr;
            if(devAddr != addr){
                devAddr = addr;
                ble_name[9] = devAddr/100 + '0';
                ble_name[10] = devAddr%100/10 + '0';
                ble_name[11] = devAddr%10 + '0';
                ble_need_set = 1;
            }
        }
        else{
            msleep(500);
        }

        msleep(50);
    }
}