drivers/event/cnxk/cnxk_tim_worker.c

   1 /* SPDX-License-Identifier: BSD-3-Clause
   2  * Copyright(C) 2021 Marvell.
   3  */
   4
   5 #include "cnxk_tim_evdev.h"
   6 #include "cnxk_tim_worker.h"
   7
   8 static inline int
   9 cnxk_tim_arm_checks(const struct cnxk_tim_ring *const tim_ring,
  10                     struct rte_event_timer *const tim)
  11 {
  12         if (unlikely(tim->state)) {
  13                 tim->state = RTE_EVENT_TIMER_ERROR;
  14                 rte_errno = EALREADY;
  15                 goto fail;
  16         }
  17
  18         if (unlikely(!tim->timeout_ticks ||
  19                      tim->timeout_ticks > tim_ring->nb_bkts)) {
  20                 tim->state = tim->timeout_ticks ?
  21                                            RTE_EVENT_TIMER_ERROR_TOOLATE :
  22                                            RTE_EVENT_TIMER_ERROR_TOOEARLY;
  23                 rte_errno = EINVAL;
  24                 goto fail;
  25         }
  26
  27         return 0;
  28
  29 fail:
  30         return -EINVAL;
  31 }
  32
  33 static inline void
  34 cnxk_tim_format_event(const struct rte_event_timer *const tim,
  35                       struct cnxk_tim_ent *const entry)
  36 {
  37         entry->w0 = (tim->ev.event & 0xFFC000000000) >> 6 |
  38                     (tim->ev.event & 0xFFFFFFFFF);
  39         entry->wqe = tim->ev.u64;
  40 }
  41
  42 static inline void
  43 cnxk_tim_sync_start_cyc(struct cnxk_tim_ring *tim_ring)
  44 {
  45         uint64_t cur_cyc = cnxk_tim_cntvct();
  46         uint32_t real_bkt;
  47
  48         if (cur_cyc - tim_ring->last_updt_cyc > tim_ring->tot_int) {
  49                 real_bkt = plt_read64(tim_ring->base + TIM_LF_RING_REL) >> 44;
  50                 cur_cyc = cnxk_tim_cntvct();
  51
  52                 tim_ring->ring_start_cyc =
  53                         cur_cyc - (real_bkt * tim_ring->tck_int);
  54                 tim_ring->last_updt_cyc = cur_cyc;
  55         }
  56 }
  57
  58 static __rte_always_inline uint16_t
  59 cnxk_tim_timer_arm_burst(const struct rte_event_timer_adapter *adptr,
  60                          struct rte_event_timer **tim, const uint16_t nb_timers,
  61                          const uint8_t flags)
  62 {
  63         struct cnxk_tim_ring *tim_ring = adptr->data->adapter_priv;
  64         struct cnxk_tim_ent entry;
  65         uint16_t index;
  66         int ret;
  67
  68         cnxk_tim_sync_start_cyc(tim_ring);
  69         for (index = 0; index < nb_timers; index++) {
  70                 if (cnxk_tim_arm_checks(tim_ring, tim[index]))
  71                         break;
  72
  73                 cnxk_tim_format_event(tim[index], &entry);
  74                 if (flags & CNXK_TIM_SP)
  75                         ret = cnxk_tim_add_entry_sp(tim_ring,
  76                                                     tim[index]->timeout_ticks,
  77                                                     tim[index], &entry, flags);
  78                 if (flags & CNXK_TIM_MP)
  79                         ret = cnxk_tim_add_entry_mp(tim_ring,
  80                                                     tim[index]->timeout_ticks,
  81                                                     tim[index], &entry, flags);
  82
  83                 if (unlikely(ret)) {
  84                         rte_errno = -ret;
  85                         break;
  86                 }
  87         }
  88
  89         return index;
  90 }
  91
  92 #define FP(_name, _f2, _f1, _flags)                                            \
  93         uint16_t __rte_noinline cnxk_tim_arm_burst_##_name(                    \
  94                 const struct rte_event_timer_adapter *adptr,                   \
  95                 struct rte_event_timer **tim, const uint16_t nb_timers)        \
  96         {                                                                      \
  97                 return cnxk_tim_timer_arm_burst(adptr, tim, nb_timers,         \
  98                                                 _flags);                       \
  99         }
 100 TIM_ARM_FASTPATH_MODES
 101 #undef FP
 102
 103 static __rte_always_inline uint16_t
 104 cnxk_tim_timer_arm_tmo_brst(const struct rte_event_timer_adapter *adptr,
 105                             struct rte_event_timer **tim,
 106                             const uint64_t timeout_tick,
 107                             const uint16_t nb_timers, const uint8_t flags)
 108 {
 109         struct cnxk_tim_ent entry[CNXK_TIM_MAX_BURST] __rte_cache_aligned;
 110         struct cnxk_tim_ring *tim_ring = adptr->data->adapter_priv;
 111         uint16_t set_timers = 0;
 112         uint16_t arr_idx = 0;
 113         uint16_t idx;
 114         int ret;
 115
 116         if (unlikely(!timeout_tick || timeout_tick > tim_ring->nb_bkts)) {
 117                 const enum rte_event_timer_state state =
 118                         timeout_tick ? RTE_EVENT_TIMER_ERROR_TOOLATE :
 119                                              RTE_EVENT_TIMER_ERROR_TOOEARLY;
 120                 for (idx = 0; idx < nb_timers; idx++)
 121                         tim[idx]->state = state;
 122
 123                 rte_errno = EINVAL;
 124                 return 0;
 125         }
 126
 127         cnxk_tim_sync_start_cyc(tim_ring);
 128         while (arr_idx < nb_timers) {
 129                 for (idx = 0; idx < CNXK_TIM_MAX_BURST && (arr_idx < nb_timers);
 130                      idx++, arr_idx++) {
 131                         cnxk_tim_format_event(tim[arr_idx], &entry[idx]);
 132                 }
 133                 ret = cnxk_tim_add_entry_brst(tim_ring, timeout_tick,
 134                                               &tim[set_timers], entry, idx,
 135                                               flags);
 136                 set_timers += ret;
 137                 if (ret != idx)
 138                         break;
 139         }
 140
 141         return set_timers;
 142 }
 143
 144 #define FP(_name, _f1, _flags)                                                 \
 145         uint16_t __rte_noinline cnxk_tim_arm_tmo_tick_burst_##_name(           \
 146                 const struct rte_event_timer_adapter *adptr,                   \
 147                 struct rte_event_timer **tim, const uint64_t timeout_tick,     \
 148                 const uint16_t nb_timers)                                      \
 149         {                                                                      \
 150                 return cnxk_tim_timer_arm_tmo_brst(adptr, tim, timeout_tick,   \
 151                                                    nb_timers, _flags);         \
 152         }
 153 TIM_ARM_TMO_FASTPATH_MODES
 154 #undef FP