#include "CLS_BSP.h"


#ifdef CLS_BSP_FDCAN

HAL_StatusTypeDef CLS_BSP_CAN_AddMessageToSend(CLS_BSP_TxHeaderType * header, uint8_t * data) {
    if (HAL_FDCAN_GetTxFifoFreeLevel(&hfdcan1) > 0) {
        return HAL_FDCAN_AddMessageToTxFifoQ(&hfdcan1, header, data);
    }
    return HAL_ERROR;
}


HAL_StatusTypeDef CLS_BSP_CAN_SetUniversalFilter(const CLS_BSP_CAN_UniversalFilter * filter) {
    FDCAN_FilterTypeDef sFilterConfig;
    sFilterConfig.IdType = FDCAN_STANDARD_ID;
    sFilterConfig.FilterIndex = filter->filterIndex;
    sFilterConfig.FilterType = filter->filterMode;
    sFilterConfig.FilterConfig = filter->filterDestination;
    sFilterConfig.FilterID1 = filter->id0;
    sFilterConfig.FilterID2 = filter->id1;
    return HAL_FDCAN_ConfigFilter(&hfdcan1, &sFilterConfig);
}

#endif



CLS_Type_t CLS_BSP_GetDeviceType(void) {
    return cls_device_Type_MASTER;
}


void CLS_BSP_SetDeviceType(CLS_Type_t type) {
}

CLS_Position_t CLS_BSP_GetPosition(void) {
    CLS_Position_t position;
    position.p0 = cls_device_Position_FRONT;
    position.p1 = cls_device_Position_CENTER;
    return position;
}

void CLS_BSP_SetPosition(CLS_Position_t position) {
}