/*
 * This file is part of the SevenCDCs project.
 * Copyright 2023 Edward V. Emelianov <edward.emelianoff@gmail.com>.
 *
 * 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 <string.h>

#include "hardware.h"
#include "usb.h"
#include "usb_lib.h"

static volatile uint8_t usbbuff[USB_TRBUFSZ]; // temporary buffer for sending data
// ring buffers for incoming and outgoing data
static uint8_t obuf[WORK_EPs][RBOUTSZ], ibuf[WORK_EPs][RBINSZ];
#define OBUF(N)  {.data = obuf[N], .length = RBOUTSZ, .head = 0, .tail = 0}
volatile ringbuffer rbout[WORK_EPs] = {OBUF(0), OBUF(1), OBUF(2), OBUF(3), OBUF(4), OBUF(5), OBUF(6)};
#define IBUF(N)  {.data = ibuf[N], .length = RBOUTSZ, .head = 0, .tail = 0}
volatile ringbuffer rbin[WORK_EPs] = {IBUF(0), IBUF(1), IBUF(2), IBUF(3), IBUF(4), IBUF(5), IBUF(6)};
// transmission is succesfull
volatile uint8_t bufisempty[WORK_EPs] = {1,1,1,1,1,1,1};
volatile uint8_t bufovrfl[WORK_EPs] = {0};

// here and later: ifNo is index of buffers, i.e. ifNo = epno-1 !!!
void send_next(int ifNo){
    if(bufisempty[ifNo]) return;
    static int lastdsz = 0;
    int buflen = RB_read((ringbuffer*)&rbout[ifNo], (uint8_t*)usbbuff, USB_TRBUFSZ);
    if(!buflen){
        if(lastdsz == 64) EP_Write(ifNo+1, NULL, 0); // send ZLP after 64 bits packet when nothing more to send
        lastdsz = 0;
        bufisempty[ifNo] = 1;
        return;
    }
    EP_Write(ifNo+1, (uint8_t*)usbbuff, buflen);
    lastdsz = buflen;
}

// blocking send full content of ring buffer
int USB_sendall(int ifNo){
    while(!bufisempty[ifNo]){
        if(!usbON) return 0;
    }
    return 1;
}

// put `buf` into queue to send
int USB_send(int ifNo, const uint8_t *buf, int len){
    if(!buf || !usbON || !len) return 0;
    uint32_t T = Tms;
    while(len){
        int a = RB_write((ringbuffer*)&rbout[ifNo], buf, len);
        if(a == 0 && Tms - T > 5) return 0; // timeout
        len -= a;
        buf += a;
        if(bufisempty[ifNo]){
            bufisempty[ifNo] = 0;
            send_next(ifNo);
        }
    }
    return 1;
}

int USB_putbyte(int ifNo, uint8_t byte){
    if(!usbON) return 0;
    while(0 == RB_write((ringbuffer*)&rbout[ifNo], &byte, 1)){
        if(bufisempty[ifNo]){
            bufisempty[ifNo] = 0;
            send_next(ifNo);
        }
    }
    return 1;
}

int USB_sendstr(int ifNo, const char *string){
    if(!string || !usbON) return 0;
    int len = 0;
    const char *b = string;
    while(*b++) ++len;
    if(!len) return 0;
    return USB_send(ifNo, (const uint8_t*)string, len);
}

/**
 * @brief USB_receive - get binary data from receiving ring-buffer
 * @param buf (i) - buffer for received data
 * @param len - length of `buf`
 * @return amount of received bytes (negative, if overfull happened)
 */
int USB_receive(int ifNo, uint8_t *buf, int len){
    int sz = RB_read((ringbuffer*)&rbin[ifNo], buf, len);
    if(bufovrfl[ifNo]){
        RB_clearbuf((ringbuffer*)&rbin[ifNo]);
        if(!sz) sz = -1;
        else sz = -sz;
        bufovrfl[ifNo] = 0;
    }
    return sz;
}

/**
 * @brief USB_receivestr - get string up to '\n' and replace '\n' with 0
 * @param buf - receiving buffer
 * @param len - its length
 * @return strlen or negative value indicating overflow (if so, string won't be ends with 0 and buffer should be cleared)
 */
int USB_receivestr(int ifNo, char *buf, int len){
    int l = RB_readto((ringbuffer*)&rbin[ifNo], '\n', (uint8_t*)buf, len);
    if(l == 0) return 0;
    if(--l < 0 || bufovrfl[ifNo]) RB_clearbuf((ringbuffer*)&rbin[ifNo]);
    else buf[l] = 0; // replace '\n' with strend
    if(bufovrfl[ifNo]){
        if(l > 0) l = -l;
        else l = -1;
        bufovrfl[ifNo] = 0;
    }
    return l;
}