ab_gp_startup_timestamp.c

Go to the documentation of this file.

#include "ab_gp_startup_timestamp.h"
 
rte_timestamp_ms_t ab_gp_startup_timestamp_agree(rte_timestamp_ms_t own_now_ms, rte_timestamp_ms_t sibling_ts_ms,
                                                 bool have_sibling)
{
    rte_timestamp_ms_t agreed = own_now_ms;
 
    if (have_sibling && (sibling_ts_ms <= own_now_ms) &&
        ((own_now_ms - sibling_ts_ms) < (rte_timestamp_ms_t)AB_GP_STARTUP_TS_FRESH_MS))
    {
        agreed = sibling_ts_ms;
    }
    return agreed;
}
 
void ab_gp_startup_timestamp_encode(uint8_t *buf, bool is_reply, rte_timestamp_ms_t ts_ms)
{
    if (buf != NULL)
    {
        uint32_t i;
 
        buf[0] = is_reply ? 1U : 0U;
        for (i = 0U; i < 8U; i++)
        {
            const uint32_t shift = 8U * i;
 
            buf[1U + i] = (uint8_t)((ts_ms >> shift) & 0xFFU);
        }
    }
}
 
bool ab_gp_startup_timestamp_decode(const uint8_t *buf, size_t size, bool *is_reply, rte_timestamp_ms_t *ts_ms)
{
    bool ok = false;
 
    if ((buf != NULL) && (is_reply != NULL) && (ts_ms != NULL) && (size >= (size_t)AB_GP_STARTUP_TS_PAYLOAD_SIZE) &&
        (buf[0] <= 1U))
    {
        rte_timestamp_ms_t value = 0U;
        uint32_t i;
 
        for (i = 0U; i < 8U; i++)
        {
            const uint32_t shift = 8U * i;
 
            value |= ((rte_timestamp_ms_t)buf[1U + i]) << shift;
        }
        *is_reply = (buf[0] == 1U);
        *ts_ms = value;
        ok = true;
    }
    return ok;
}