#include <sysinit.h>

#include "basic/basic.h"
#include "basic/byteorder.h"

#include "lcd/lcd.h"
#include "lcd/print.h"

#include "funk/nrf24l01p.h"
#include "usbcdc/usb.h"
#include "usbcdc/usbcore.h"
#include "usbcdc/usbhw.h"
#include "usbcdc/cdcuser.h"
#include "usbcdc/cdc_buf.h"
#include "usbcdc/util.h"

#include <string.h>

#define REMOTE_CHANNEL 91
#define REMOTE_MAC     "REM0T"

#if CFG_USBMSC
#error "MSC is defined"
#endif

#if !CFG_USBCDC
#error "CDC is not defined"
#endif

/**************************************************************************/

#include "SECRETS"

void r_init(void){
    nrf_init();

    struct NRF_CFG config = {
        .channel= REMOTE_CHANNEL,
        .txmac= REMOTE_MAC,
        .nrmacs=1,
        .mac0=  REMOTE_MAC,
        .maclen ="\x10",
    };

    nrf_config_set(&config);
};

void s_init(void){
    usbCDCInit();
    nrf_init();

    struct NRF_CFG config = {
        .channel= REMOTE_CHANNEL,
        .txmac= REMOTE_MAC,
        .nrmacs=1,
        .mac0=  REMOTE_MAC,
        .maclen ="\x10",
    };

    nrf_config_set(&config);
};

 void process(uint8_t * input){
    __attribute__ ((aligned (4))) uint8_t buf[32];
    puts("process: ");
    puts(input);
    puts("\r\n");
    if(input[0]=='M'){
        buf[0]=0x10; // Length: 16 bytes
        buf[1]='M'; // Proto
        buf[2]=0x01;
        buf[3]=0x01; // Unused

        uint32touint8p(0,buf+4);

        uint32touint8p(0x41424344,buf+8);

        buf[12]=0xff; // salt (0xffff always?)
        buf[13]=0xff;
        nrf_snd_pkt_crc_encr(16,buf,remotekey);
        nrf_rcv_pkt_start();
    };

};

#define INPUTLEN 99
void r_recv(void){
    __attribute__ ((aligned (4))) uint8_t buf[32];
    int len;

    uint8_t input[INPUTLEN+1];
    int inputptr=0;

    nrf_rcv_pkt_start();
    puts("D start");

    getInputWaitRelease();

    while(!getInputRaw()){
        delayms(100);

        // Input
        int l=INPUTLEN-inputptr;
        CDC_OutBufAvailChar (&l);

        if(l>0){
            CDC_RdOutBuf (input+inputptr, &l);
            input[inputptr+l+1]=0;
            for(int i=0;i<l;i++){
                if(input[inputptr+i] =='\r'){
                    input[inputptr+i]=0;
                    process(input);
                    if(i<l)
                        memmove(input,input+inputptr+i+1,l-i);
                    inputptr=-i-1;
                    break;
                };
            };
        };
        inputptr+=l;
        len=nrf_rcv_pkt_poll_dec(sizeof(buf),buf,remotekey);

        // Receive
        if(len<=0){
            delayms(10);
            continue;
        };

        if(buf[1]=='C'){ // Cursor
            puts("C ");
            puts(IntToStrX( buf[2],2 ));
            puts(" ");
            puts(IntToStrX( uint8ptouint32(buf+4), 8 ));
            puts(" ");
            puts(IntToStrX( uint8ptouint32(buf+8), 8 ));
        }else{
            puts("U ");
//          puts("[");puts(IntToStrX(len,2));puts("] ");
            puts(IntToStrX( *(int*)(buf+  0),2 ));
            puts(" ");
            puts(IntToStrX( *(int*)(buf+  1),2 ));
            puts(" ");
            puts(IntToStrX( *(int*)(buf+  2),2 ));
            puts(" ");
            puts(IntToStrX( *(int*)(buf+  3),2 ));
            puts(" ");
            puts(IntToStrX( uint8ptouint32(buf+4),8 ));
            puts(".");
            puts(IntToStrX( uint8ptouint32(buf+8),8 ));
            puts(" ");
            puts(IntToStrX( uint8ptouint32(buf+10),4 ));
        };
        puts("\r\n");

    };

    nrf_rcv_pkt_end();
    puts("D exit");
}


void r_s1(void){
    static int ctr=1;
    __attribute__ ((aligned (4))) uint8_t buf[32];
    int status;

    buf[0]=0x10; // Length: 16 bytes
    buf[1]='1'; // Proto
    buf[2]=0x00;
    buf[3]=0x00; // Unused

    uint32touint8p(ctr++,buf+4);

    uint32touint8p(0x5ec,buf+8);

    buf[12]=0xff; // salt (0xffff always?)
    buf[13]=0xff;
    status=nrf_snd_pkt_crc_encr(16,buf,remotekey);

    lcdClear();
    lcdPrint("F-St:"); lcdPrintInt(status); 
    lcdDisplay();

};
void r_s2(void){
    static int ctr=1;
    __attribute__ ((aligned (4))) uint8_t buf[32];
    int status;

    buf[0]=0x10; // Length: 16 bytes
    buf[1]='C'; // Proto
    buf[2]=0x00;
    buf[3]=0x00; // Unused

    uint32touint8p(ctr++,buf+4);

    uint32touint8p(0x5ec,buf+8);

    buf[12]=0xff; // salt (0xffff always?)
    buf[13]=0xff;
    status=nrf_snd_pkt_crc_encr(16,buf,remotekey);

    buf[0]=0x10; // Length: 16 bytes
    buf[1]='I'; // Proto
    buf[2]=0x00;
    buf[3]=0x00; // Unused

    uint32touint8p(ctr++,buf+4);

    uint32touint8p(0x5ec,buf+8);

    buf[12]=0xff; // salt (0xffff always?)
    buf[13]=0xff;
    status=nrf_snd_pkt_crc_encr(16,buf,remotekey);

    lcdClear();
    lcdPrint("F-St:"); lcdPrintInt(status); 
    lcdDisplay();

};

void r_send(void){
    int ctr=1;
    __attribute__ ((aligned (4))) uint8_t buf[32];
    int len;
    int status;

    while(1){

        buf[0]=0x10; // Length: 16 bytes
        buf[1]='C'; // Proto
        buf[2]=getInputRaw();
        buf[3]=0x00; // Unused

        ctr++;
        *(int*)(buf+4)=ctr;

        /*
        buf[4]=0x00; // ctr
        buf[5]=0x00; // ctr
        buf[6]=0x00; // ctr
        buf[7]=ctr++; // ctr
        */

        buf[8]=0x0; // Object id
        buf[9]=0x0;
        buf[10]=0x05;
        buf[11]=0xec;

        buf[12]=0xff; // salt (0xffff always?)
        buf[13]=0xff;

        lcdClear();
        lcdPrint("Key:"); lcdPrintInt(buf[2]); lcdNl();
        if(buf[2]==BTN_ENTER)
            break;

        status=nrf_snd_pkt_crc_encr(16,buf,remotekey);

        lcdPrint("F-St:"); lcdPrintInt(status); 
        lcdDisplay();

        len=nrf_rcv_pkt_time_encr(100,sizeof(buf),buf,remotekey);
        if(len>0){
            lcdPrint("Got!");
            lcdDisplay();
            break;
        };
        delayms(10);
    };
};