/*
 *                                                                                                  geany_encoding=koi8-r
 * usb.c - base functions for different USB types
 *
 * Copyright 2018 Edward V. Emelianov <eddy@sao.ru, 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 2 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, write to the Free Software
 * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston,
 * MA 02110-1301, USA.
 *
 */
#include "usb.h"
#include "usb_lib.h"

static volatile uint8_t tx_succesfull = 1;
static uint8_t rxNE = 0;

static void rxtx_Handler(){
    uint16_t epstatus = KEEP_DTOG(USB->EPnR[1]);
    if(RX_FLAG(epstatus)){
        rxNE = 1;
        epstatus = (epstatus & ~(USB_EPnR_STAT_TX|USB_EPnR_CTR_RX)) ^ USB_EPnR_STAT_RX; // keep stat Tx & set valid RX, clear CTR Rx
    }else{
        tx_succesfull = 1;
        epstatus = (epstatus & ~(USB_EPnR_STAT_TX|USB_EPnR_CTR_TX)) ^ USB_EPnR_STAT_RX; // keep stat Tx & set valid RX, clear CTR Tx
    }
    USB->EPnR[1] = epstatus;
}

void USB_setup(){
    NVIC_DisableIRQ(USB_LP_CAN1_RX0_IRQn);
    NVIC_DisableIRQ(USB_HP_CAN1_TX_IRQn);
    RCC->APB1ENR |= RCC_APB1ENR_USBEN;
    USB->CNTR   = USB_CNTR_FRES; // Force USB Reset
    for(uint32_t ctr = 0; ctr < 72000; ++ctr) nop(); // wait >1ms
    USB->CNTR   = 0;
    USB->BTABLE = 0;
    USB->DADDR  = 0;
    USB->ISTR   = 0;
    USB->CNTR   = USB_CNTR_RESETM | USB_CNTR_WKUPM; // allow only wakeup & reset interrupts
    NVIC_EnableIRQ(USB_LP_CAN1_RX0_IRQn);
}


static int usbwr(const uint8_t *buf, uint16_t l){
    uint32_t ctra = 1000000;
    while(--ctra && tx_succesfull == 0){
        IWDG->KR = IWDG_REFRESH;
    }
    tx_succesfull = 0;
    EP_Write(1, buf, l);
    ctra = 1000000;
    while(--ctra && tx_succesfull == 0){
        IWDG->KR = IWDG_REFRESH;
    }
    if(tx_succesfull == 0){usbON = 0; return 1;} // usb is OFF?
    return 0;
}

static uint8_t usbbuff[USB_TXBUFSZ-1]; // temporary buffer (63 - to prevent need of ZLP)
static uint8_t buflen = 0; // amount of symbols in usbbuff

// send next up to 64 bytes of data in usbbuff
static void send_next(){
    if(!buflen || !tx_succesfull) return;
    tx_succesfull = 0;
    EP_Write(1, usbbuff, buflen);
    buflen = 0;
}

// unblocking sending - just fill a buffer
void USB_send(const uint8_t *buf, uint16_t len){
    if(!usbON || !len) return;
    if(len > USB_TXBUFSZ-1 - buflen){
        usbwr(usbbuff, buflen);
        buflen = 0;
    }
    if(len > USB_TXBUFSZ-1){
        USB_send_blk(buf, len);
        return;
    }
    while(len--) usbbuff[buflen++] = *buf++;
}

// send zero-terminated string
void USB_sendstr(const char *str){
    uint16_t l = 0;
    const char *ptr = str;
    while(*ptr++) ++l;
    USB_send((uint8_t*)str, l);
}

// blocking sending
void USB_send_blk(const uint8_t *buf, uint16_t len){
    if(!usbON || !len) return; // USB disconnected
    if(buflen){
        usbwr(usbbuff, buflen);
        buflen = 0;
    }
    int needzlp = 0;
    while(len){
        if(len == USB_TXBUFSZ) needzlp = 1;
        uint16_t s = (len > USB_TXBUFSZ) ? USB_TXBUFSZ : len;
        if(usbwr(buf, s)) return;
        len -= s;
        buf += s;
    }  
    if(needzlp){
        usbwr(NULL, 0);
    }
}

void usb_proc(){
    switch(USB_Dev.USB_Status){
        case USB_STATE_CONFIGURED:
            // make new BULK endpoint
            // Buffer have 1024 bytes, but last 256 we use for CAN bus (30.2 of RM: USB main features)
            //EP_Init(1, EP_TYPE_INTERRUPT, USB_EP1BUFSZ, 0, EP1_Handler); // IN1 - transmit
            EP_Init(1, EP_TYPE_BULK, USB_TXBUFSZ, USB_RXBUFSZ, rxtx_Handler); // INOUT1 - transmit/receive data
            USB_Dev.USB_Status = USB_STATE_CONNECTED;
        break;
        case USB_STATE_DEFAULT:
        case USB_STATE_ADDRESSED:
            if(usbON){
                usbON = 0;
            }
        break;
        default: // USB_STATE_CONNECTED - send next data portion
            if(!usbON) return;
            send_next();
    }
}

/**
 * @brief USB_receive
 * @param buf (i) - buffer[64] for received data
 * @return amount of received bytes
 */
uint8_t USB_receive(uint8_t *buf){
    if(!usbON || !rxNE) return 0;
    uint8_t sz = EP_Read(1, (uint16_t*)buf);
    uint16_t epstatus = KEEP_DTOG(USB->EPnR[1]);
    // keep stat_tx & set ACK rx
    USB->EPnR[1] = (epstatus & ~(USB_EPnR_STAT_TX)) ^ USB_EPnR_STAT_RX;
    rxNE = 0;
    return sz;
}