Branch data     Line data    Source code

       1                 :            : /* SPDX-License-Identifier: BSD-3-Clause
       2                 :            :  * Copyright(C) 2023 Marvell.
       3                 :            :  */
       4                 :            : 
       5                 :            : #include <rte_byteorder.h>
       6                 :            : #include <rte_mbuf.h>
       7                 :            : #include <rte_pdcp_hdr.h>
       8                 :            : 
       9                 :            : #include "pdcp_ctrl_pdu.h"
      10                 :            : #include "pdcp_entity.h"
      11                 :            : #include "pdcp_cnt.h"
      12                 :            : 
      13                 :            : static inline uint16_t
      14                 :            : round_up_bits(uint32_t bits)
      15                 :            : {
      16                 :            :         /* round up to the next multiple of 8 */
      17                 :          0 :         return RTE_ALIGN_MUL_CEIL(bits, 8) / 8;
      18                 :            : }
      19                 :            : 
      20                 :            : static __rte_always_inline void
      21                 :            : pdcp_hdr_fill(struct rte_pdcp_up_ctrl_pdu_hdr *pdu_hdr, uint32_t rx_deliv)
      22                 :            : {
      23                 :          0 :         pdu_hdr->d_c = RTE_PDCP_PDU_TYPE_CTRL;
      24                 :          0 :         pdu_hdr->pdu_type = RTE_PDCP_CTRL_PDU_TYPE_STATUS_REPORT;
      25                 :          0 :         pdu_hdr->r = 0;
      26         [ #  # ]:          0 :         pdu_hdr->fmc = rte_cpu_to_be_32(rx_deliv);
      27                 :            : }
      28                 :            : 
      29                 :            : int
      30                 :          0 : pdcp_ctrl_pdu_status_gen(struct entity_priv *en_priv, struct entity_priv_dl_part *dl,
      31                 :            :                          struct rte_mbuf *m)
      32                 :            : {
      33                 :            :         struct rte_pdcp_up_ctrl_pdu_hdr *pdu_hdr;
      34                 :            :         uint32_t rx_deliv, actual_sz;
      35                 :            :         uint16_t pdu_sz, bitmap_sz;
      36                 :            :         uint8_t *data;
      37                 :            : 
      38         [ #  # ]:          0 :         if (!en_priv->flags.is_status_report_required)
      39                 :            :                 return -EINVAL;
      40                 :            : 
      41                 :            :         pdu_sz = sizeof(struct rte_pdcp_up_ctrl_pdu_hdr);
      42                 :            : 
      43                 :          0 :         rx_deliv = en_priv->state.rx_deliv;
      44                 :            : 
      45                 :            :         /* Zero missing PDUs - status report contains only FMC */
      46         [ #  # ]:          0 :         if (rx_deliv >= en_priv->state.rx_next) {
      47                 :            :                 pdu_hdr = (struct rte_pdcp_up_ctrl_pdu_hdr *)rte_pktmbuf_append(m, pdu_sz);
      48         [ #  # ]:          0 :                 if (pdu_hdr == NULL)
      49                 :          0 :                         return -ENOMEM;
      50                 :            :                 pdcp_hdr_fill(pdu_hdr, rx_deliv);
      51                 :            : 
      52                 :          0 :                 return 0;
      53                 :            :         }
      54                 :            : 
      55                 :          0 :         actual_sz = RTE_MIN(round_up_bits(en_priv->state.rx_next - rx_deliv - 1),
      56                 :            :                         RTE_PDCP_CTRL_PDU_SIZE_MAX - pdu_sz);
      57                 :          0 :         bitmap_sz = pdcp_cnt_get_bitmap_size(actual_sz);
      58                 :            : 
      59                 :          0 :         data = (uint8_t *)rte_pktmbuf_append(m, pdu_sz + bitmap_sz);
      60         [ #  # ]:          0 :         if (data == NULL)
      61                 :          0 :                 return -ENOMEM;
      62                 :            : 
      63                 :          0 :         m->pkt_len = pdu_sz + actual_sz;
      64         [ #  # ]:          0 :         m->data_len = pdu_sz + actual_sz;
      65                 :            : 
      66                 :            :         pdcp_hdr_fill((struct rte_pdcp_up_ctrl_pdu_hdr *)data, rx_deliv);
      67                 :            : 
      68                 :          0 :         data = RTE_PTR_ADD(data, pdu_sz);
      69                 :          0 :         pdcp_cnt_report_fill(dl->bitmap, en_priv->state, data, bitmap_sz);
      70                 :            : 
      71                 :          0 :         return 0;
      72                 :            : }