#define IVEC_ECU_CAN_H

#include "../Core/Include/ivec_mcal_mcan.h"
#include "../ivec_ECU/ivec_ecu_common/inc/ivec_ecu_common.h"

#include "stdint.h"
#include <stdio.h>
#include <stdlib.h>
#include <string.h>

#define QUEUE(name, buff)                               \
    volatile can_queue_t name = {                       \
            .front = 0,                                 \
            .rear = 0,                                  \
            .size = (sizeof(buff)/sizeof(buff[0])),     \
            .element_size = sizeof(buff[0]),            \
            .buffer = buff,                             \
            }

#define FLUSH(name) do {                                \
    name.front = 0;                                     \
    name.rear = 0;                                      \
    memset(name.buffer, 0x00, name.size);   \
    } while(0)

#define ENQUEUE(queue, data) do {                               \
    memcpy(&queue.buffer[queue.front++], &data, sizeof(data));  \
    queue.front %= queue.size;                                  \
    } while(0)


#define DEQUEUE(queue, data) do {                               \
    memcpy(&data, &queue.buffer[queue.rear++], sizeof(data));   \
    queue.rear %= queue.size;                                   \
    } while(0)


#define IS_FULL(queue) ((queue.front - queue.rear) == (queue.size -1) || \
                        (queue.front - queue.rear) == -1)

#define IS_EMPTY(queue) (queue.front == queue.rear)


/*Private Variable*/
typedef struct {
    uint32_t id;
    uint8_t data[8];
    uint8_t length;
    uint8_t resv[3];
} can_buff_t;

typedef struct {
    uint16_t front;
    uint16_t rear;
    uint16_t size;
    uint8_t element_size;
    can_buff_t * buffer;
} can_queue_t;



void mcu_FDCAN_RxFifo_Callback(uint32_t Identifier, uint8_t *data, uint16_t DataLength);
uint8_t store_msg_from_isr_to_queue(uint32_t id, uint8_t* data, uint8_t len);

IVEC_EcuCommonErr_e xECU_CANInit(MCAN_Regs* MCAN, xCAN_baud_t BAUD);
IVEC_EcuCommonErr_e xECU_CANDeInit(MCAN_Regs* MCAN);
IVEC_EcuCommonErr_e xECU_WriteDataOverCAN(uint8_t* pucBuf, uint32_t ulId, int retCode, uint32_t BufNum);
IVEC_EcuCommonErr_e xECU_CANGetData(can_buff_t *xBuff);
IVEC_EcuCommonErr_e xECU_CanReInit(MCAN_Regs* MCAN,uint16_t speed);