odp_ipfragreass_ip.h

/* SPDX-License-Identifier: BSD-3-Clause
 * Copyright (c) 2017-2018 Linaro Limited
 */
 
#ifndef ODP_FRAGREASS_PP_IP_H_
#define ODP_FRAGREASS_PP_IP_H_
 
#include <odp/helper/ip.h>
 
#define IP_HDR_LEN_MIN  ODPH_IPV4HDR_LEN
#define IP_HDR_LEN_MAX  60
#define IP_IHL_MIN  ODPH_IPV4HDR_IHL_MIN
#define IP_IHL_MAX  15
#define IP_OCTET_MAX    ((1U << 14U) - 1U) /* 65535 bytes, 8192 octs, 14 bits */
#define IP_FRAGOFF_MAX  8192 /* 13 bits */
 
#define IP_FRAG_RESV 0x8000 
#define IP_FRAG_DONT 0x4000 
#define IP_FRAG_MORE 0x2000 
#define IP_FRAG_MASK 0x1fff 
#define BYTES_TO_OCTS(bytes)    (((bytes) + 7U) / 8U)
#define OCTS_TO_BYTES(bytes)    ((bytes) * 8)
#define WORDS_TO_BYTES(words)   ((words) * 4)
 
static inline void ipv4hdr_init(odph_ipv4hdr_t *h)
{
    h->ver_ihl     = 0x45; /* IHL of 5, Version of 4 [0x45 = 0100 0101] */
    h->tos         = 0;
    h->tot_len     = odp_cpu_to_be_16(IP_HDR_LEN_MIN);
    h->frag_offset = 0;
    h->ttl         = UINT8_MAX;
    h->chksum      = 0;
}
 
static inline uint8_t ipv4hdr_ihl_words(odph_ipv4hdr_t h)
{
    return ODPH_IPV4HDR_IHL(h.ver_ihl);
}
 
static inline uint8_t ipv4hdr_ihl(odph_ipv4hdr_t h)
{
    return WORDS_TO_BYTES(ipv4hdr_ihl_words(h));
}
 
static inline void ipv4hdr_set_ihl_words(odph_ipv4hdr_t *h, uint8_t ihl)
{
    h->ver_ihl = (ODPH_IPV4HDR_VER(h->ver_ihl) << 4)
             | ODPH_IPV4HDR_IHL(ihl);
}
 
static inline bool ipv4hdr_dont_fragment(odph_ipv4hdr_t h)
{
    return (h.frag_offset & odp_cpu_to_be_16(IP_FRAG_DONT));
}
 
static inline void ipv4hdr_set_dont_fragment(odph_ipv4hdr_t *h, bool df)
{
    if (df)
        h->frag_offset |=  odp_cpu_to_be_16(IP_FRAG_DONT);
    else
        h->frag_offset &= ~odp_cpu_to_be_16(IP_FRAG_DONT);
}
 
static inline bool ipv4hdr_more_fragments(odph_ipv4hdr_t h)
{
    return (h.frag_offset & odp_cpu_to_be_16(IP_FRAG_MORE));
}
 
static inline void ipv4hdr_set_more_fragments(odph_ipv4hdr_t *h, bool mf)
{
    if (mf)
        h->frag_offset |=  odp_cpu_to_be_16(IP_FRAG_MORE);
    else
        h->frag_offset &= ~odp_cpu_to_be_16(IP_FRAG_MORE);
}
 
static inline bool ipv4hdr_is_fragment(odph_ipv4hdr_t h)
{
    return (h.frag_offset & odp_cpu_to_be_16(IP_FRAG_MORE | IP_FRAG_MASK));
}
 
static inline uint16_t ipv4hdr_fragment_offset_oct(odph_ipv4hdr_t h)
{
    return (odp_be_to_cpu_16(h.frag_offset) & IP_FRAG_MASK);
}
 
static inline void ipv4hdr_set_fragment_offset_oct(odph_ipv4hdr_t *h,
                           uint16_t offset)
{
    h->frag_offset = odp_cpu_to_be_16((odp_be_to_cpu_16(h->frag_offset)
                       & ~IP_FRAG_MASK) | offset);
}
 
static inline uint16_t ipv4hdr_payload_len(odph_ipv4hdr_t h)
{
    uint32_t packet_len  = odp_be_to_cpu_16(h.tot_len);
    uint32_t header_size = ipv4hdr_ihl(h);
 
    return (uint16_t)(packet_len >= header_size ? (packet_len - header_size)
                            : 0);
}
 
static inline uint16_t ipv4hdr_payload_len_oct(odph_ipv4hdr_t h)
{
    return BYTES_TO_OCTS(ipv4hdr_payload_len(h));
}
 
static inline void ipv4hdr_set_payload_len(odph_ipv4hdr_t *h, uint16_t len)
{
    h->tot_len = odp_cpu_to_be_16(len + ipv4hdr_ihl(*h));
}
 
static inline uint16_t ipv4hdr_reass_payload_len(odph_ipv4hdr_t h)
{
    uint16_t fragment_offset_oct;
 
    if (ipv4hdr_more_fragments(h))
        return UINT16_MAX;
 
    fragment_offset_oct = ipv4hdr_fragment_offset_oct(h);
    return OCTS_TO_BYTES(fragment_offset_oct) + ipv4hdr_payload_len(h);
}
 
static inline uint16_t ipv4hdr_reass_payload_len_oct(odph_ipv4hdr_t h)
{
    uint16_t fragment_offset_oct;
 
    if (ipv4hdr_more_fragments(h))
        return IP_OCTET_MAX;
 
    fragment_offset_oct = ipv4hdr_fragment_offset_oct(h);
    return fragment_offset_oct + ipv4hdr_payload_len_oct(h);
}
 
#endif