protocol_adapter.c

Go to the documentation of this file.

#include "safecomm/adapter/protocol_adapter.h"
 
#include <string.h>
 
static safecomm_status_t adapter_open_saf(safecomm_adapter_t *adapter,
                                          const safecomm_adapter_config_t *config,
                                          const safecomm_transport_t *transport)
{
    if ((adapter == NULL) || (config == NULL) || (transport == NULL))
    {
        return SAFECOMM_STATUS_INVALID_PARAM;
    }
 
    (void)memset(adapter, 0, sizeof(*adapter));
    adapter->cfg = *config;
 
    safecomm_saf_config_t saf_cfg;
    (void)memset(&saf_cfg, 0, sizeof(saf_cfg));
 
    saf_cfg.role         = config->role;
    saf_cfg.etcs_id_self = config->id_self;
    saf_cfg.etcs_id_peer = config->id_peer;
    (void)memcpy(saf_cfg.kmac, config->kmac, SAFECOMM_MAC_KEY_LEN);
 
    if (config->sublayer == SAFECOMM_SUBLAYER_SAF_SS098)
    {
        saf_cfg.t_connect_ms     = (config->t_connect_ms > 0U) ? config->t_connect_ms : 5000U;
        saf_cfg.t_supervision_ms = (config->t_supervision_ms > 0U) ? config->t_supervision_ms : 10000U;
    }
    else
    {
        saf_cfg.t_connect_ms     = (config->t_connect_ms > 0U) ? config->t_connect_ms : 10000U;
        saf_cfg.t_supervision_ms = (config->t_supervision_ms > 0U) ? config->t_supervision_ms : 20000U;
    }
 
    safecomm_status_t st = safecomm_saf_init(&adapter->conn, &saf_cfg, transport);
    if (st != SAFECOMM_STATUS_OK)
    {
        return st;
    }
 
    adapter->is_open = true;
    return SAFECOMM_STATUS_OK;
}
 
static safecomm_status_t adapter_send_saf(safecomm_adapter_t *adapter,
                                          const void *data, size_t size)
{
    if ((adapter == NULL) || (!adapter->is_open))
    {
        return SAFECOMM_STATUS_STATE;
    }
    return safecomm_saf_send(&adapter->conn, (const uint8_t *)data, size);
}
 
static safecomm_status_t adapter_receive_saf(safecomm_adapter_t *adapter,
                                             void *out_buf, size_t buffer_size,
                                             size_t *out_len)
{
    if ((adapter == NULL) || (!adapter->is_open))
    {
        return SAFECOMM_STATUS_STATE;
    }
    return safecomm_saf_recv(&adapter->conn, (uint8_t *)out_buf, buffer_size, out_len);
}
 
static safecomm_status_t adapter_close_saf(safecomm_adapter_t *adapter)
{
    if ((adapter == NULL) || (!adapter->is_open))
    {
        return SAFECOMM_STATUS_OK;
    }
    safecomm_status_t st = safecomm_saf_disconnect(&adapter->conn);
    adapter->is_open = false;
    return st;
}
 
/* Subset-098 Protocol Adapter Vtable */
static const safecomm_protocol_ops_t G_SS098_OPS = {
    .open    = adapter_open_saf,
    .send    = adapter_send_saf,
    .receive = adapter_receive_saf,
    .close   = adapter_close_saf
};
 
/* Subset-037 Protocol Adapter Vtable */
static const safecomm_protocol_ops_t G_SS037_OPS = {
    .open    = adapter_open_saf,
    .send    = adapter_send_saf,
    .receive = adapter_receive_saf,
    .close   = adapter_close_saf
};
 
/* RaSTA (DIN VDE V 0831-102) Protocol Adapter Hook */
static safecomm_status_t adapter_open_rasta(safecomm_adapter_t *adapter,
                                            const safecomm_adapter_config_t *config,
                                            const safecomm_transport_t *transport)
{
    if ((adapter == NULL) || (config == NULL) || (transport == NULL))
    {
        return SAFECOMM_STATUS_INVALID_PARAM;
    }
    /* RaSTA RedL + SafeL architecture integration hook */
    return SAFECOMM_STATUS_NOT_IMPLEMENTED;
}
 
static const safecomm_protocol_ops_t G_RASTA_OPS = {
    .open    = adapter_open_rasta,
    .send    = adapter_send_saf,
    .receive = adapter_receive_saf,
    .close   = adapter_close_saf
};
 
const safecomm_protocol_ops_t *safecomm_protocol_adapter_get_ss098(void)
{
    return &G_SS098_OPS;
}
 
const safecomm_protocol_ops_t *safecomm_protocol_adapter_get_ss037(void)
{
    return &G_SS037_OPS;
}
 
const safecomm_protocol_ops_t *safecomm_protocol_adapter_get_rasta(void)
{
    return &G_RASTA_OPS;
}