//
// Created by cfif on 16.09.22.
//
#include <SystemDelayInterface.h>
#include "SerialPortGiga.h"


void vSerialPortInit(
        tSerialPortGiga *env,
        uint32_t uart,
        uint32_t rxBufferLength
) {

    env->rxDataQueue = osMessageQueueNew(rxBufferLength, 1, NULL);

    env->uart = uart;
}

/*
void vSerialPortInitDMA(
        tSerialPortArtery *env,
        usart_type *uart,

        dma_type *DMA,
        dma_channel_type *DMA_CHANNEL,
//        dmamux_channel_type *DMA_CHANNEL_MUX,
//        dmamux_requst_id_sel_type DMAMUX_DMAREQ_ID,
        uint8_t FLEX_CHANNEL,
        uint8_t DMA_FLEXIBLE_UART,

        uint8_t *DMA_BUF,
        uint16_t DMA_BUF_LEN,
        IRQn_Type DMA_Channel_IRQ,


        bool swap,
        uint32_t BoundRate,
        IRQn_Type irq,
        crm_periph_clock_type uartClock,
        uint8_t irqPriority,
        uint32_t rxBufferLength,
        uint32_t rxSnifferLength
) {
    usart_reset(uart);

    crm_periph_clock_enable(uartClock, TRUE);

    usart_init(uart, BoundRate, USART_DATA_8BITS, USART_STOP_1_BIT);
    usart_parity_selection_config(uart, USART_PARITY_NONE);

    usart_transmitter_enable(uart, TRUE);
    usart_receiver_enable(uart, TRUE);

    usart_dma_receiver_enable(uart, TRUE);

    if (swap) {
//        usart_transmit_receive_pin_swap(uart, TRUE);
    }

    usart_enable(uart, TRUE);

    usart_interrupt_enable(uart, USART_IDLE_INT, TRUE);

    NVIC_EnableIRQ(irq);
    NVIC_SetPriority(irq, irqPriority);

    env->rxDataQueue = osMessageQueueNew(rxBufferLength, 1, NULL);

    if (rxSnifferLength) {
        env->rxDataSnifferQueue = osMessageQueueNew(rxSnifferLength, 1, NULL);
    } else {
        env->rxDataSnifferQueue = 0;
    }

    env->uart = uart;


//    dma_init_type dma_init_struct;

    // enable dma1 clock
    crm_periph_clock_enable(CRM_DMA1_PERIPH_CLOCK, TRUE);

//    dmamux_enable(DMA, TRUE);

    // dma channel for usart rx configuration
    dma_reset(DMA_CHANNEL);
    dma_default_para_init(&env->dma_init_struct);
    env->dma_init_struct.buffer_size = DMA_BUF_LEN;
    env->dma_init_struct.direction = DMA_DIR_PERIPHERAL_TO_MEMORY;
    env->dma_init_struct.memory_base_addr = (uint32_t) DMA_BUF;
    env->dma_init_struct.memory_data_width = DMA_MEMORY_DATA_WIDTH_BYTE;
    env->dma_init_struct.memory_inc_enable = TRUE;
    env->dma_init_struct.peripheral_base_addr = (uint32_t) &uart->dt;
    env->dma_init_struct.peripheral_data_width = DMA_PERIPHERAL_DATA_WIDTH_BYTE;
    env->dma_init_struct.peripheral_inc_enable = FALSE;
    env->dma_init_struct.priority = DMA_PRIORITY_MEDIUM;
    env->dma_init_struct.loop_mode_enable = TRUE;
    dma_init(DMA_CHANNEL, &env->dma_init_struct);

    // enable transfer full data intterrupt
    dma_interrupt_enable(DMA_CHANNEL, DMA_FDT_INT, TRUE);

    // dma1 channel4 interrupt nvic init
//    nvic_irq_enable(DMA1_Channel4_IRQn, 0, 0);
    NVIC_EnableIRQ(DMA_Channel_IRQ);
    NVIC_SetPriority(DMA_Channel_IRQ, irqPriority);


    dma_flexible_config(DMA, FLEX_CHANNEL, DMA_FLEXIBLE_UART);
//    dmamux_init(DMA_CHANNEL_MUX, DMAMUX_DMAREQ_ID);

    env->dma_channel = DMA_CHANNEL;
    env->dma_buf = DMA_BUF;
    env->offset = 0;

    dma_channel_enable(DMA_CHANNEL, TRUE);


}
*/

void vSerialPortIrqProcessingDMAloop(tSerialPortGiga *env, uint32_t len) {

    for (uint32_t i = env->offset; i < len; ++i) {
        osMessageQueuePut(env->rxDataQueue, &env->dma_buf[i], 0x0, 0U);
        if (env->rxDataSnifferQueue) {
            osMessageQueuePut(env->rxDataSnifferQueue, &env->dma_buf[i], 0x0, 0U);
        }
    }

    env->offset = len;
}


void vSerialPortIrqProcessing(tSerialPortGiga *env) {
    uint8_t data;

    while (usart_flag_get(env->uart, USART_FLAG_RBNE)) {
        data = usart_data_receive(env->uart);
        osMessageQueuePut(env->rxDataQueue, &data, 0x0, 0U);
        if (env->rxDataSnifferQueue) {
            osMessageQueuePut(env->rxDataSnifferQueue, &data, 0x0, 0U);
        }
    }
}


static uint16_t vSerialPortReceiveQueue(tSerialPortGiga *env, uint8_t *data, uint16_t size, uint32_t timeout,
                                        osMessageQueueId_t queueId) {
    uint16_t received = 0;


    if (timeout) {
        uint32_t endMs = SystemGetMs() + timeout;
        uint32_t leftMs;

        while (size && ((timeout == SystemWaitForever) || (endMs > SystemGetMs()))) {
            leftMs = endMs - SystemGetMs();
            if (osMessageQueueGet(queueId, data, NULL, leftMs) == osOK) {
                --size;
                ++received;
                ++data;
            }
        }

    } else {
        while (size) {
            if (osMessageQueueGet(queueId, data, NULL, 0) == osOK) {
                --size;
                ++received;
                ++data;
            } else {
                return received;
            }
        }
    }

    return received;

}

static uint16_t vSerialPortReceive(tSerialPortGiga *env, uint8_t *data, uint16_t size, uint32_t timeout) {
    return vSerialPortReceiveQueue(env, data, size, timeout, env->rxDataQueue);
}

static uint16_t vSerialPortReceiveSniffer(tSerialPortGiga *env, uint8_t *data, uint16_t size, uint32_t timeout) {

    return env->rxDataSnifferQueue
           ? vSerialPortReceiveQueue(env, data, size, timeout, env->rxDataSnifferQueue)
           : 0;
}

uint16_t vSerialPortTransmit(tSerialPortGiga *env, uint8_t *data, uint16_t size, uint32_t timeout) {
    uint16_t sent = 0;

    uint32_t endMs = SystemGetMs() + timeout;

    while (size && ((timeout == SystemWaitForever) || (endMs > SystemGetMs()))) {

        if (usart_flag_get(env->uart, USART_FLAG_TBE)) {
            usart_data_transmit(env->uart, *data);
            --size;
            ++data;
            ++sent;
        }

    }

    while ((timeout == SystemWaitForever) || (endMs > SystemGetMs())) {
        if (usart_flag_get(env->uart, USART_FLAG_TC))
            break;
    }

    return sent;
}

tSerialPortIO vSerialPortGetIo(tSerialPortGiga *env) {
    tSerialPortIO io = {
            .env = env,
            .receive = (SerialPortIOTransaction) vSerialPortReceive,
            .transmit = (SerialPortIOTransaction) vSerialPortTransmit
    };
    return io;
}

tSerialPortIO vSerialPortGetSnifferIo(tSerialPortGiga *env) {
    tSerialPortIO io = {
            .env = env,
            .receive = (SerialPortIOTransaction) vSerialPortReceiveSniffer,
            .transmit = (SerialPortIOTransaction) vSerialPortTransmit
    };
    return io;
}