common/cnxk: support anti-replay check in SW for cn9k

[dpdk.git] / drivers / common / cnxk / roc_bphy_irq.c

diff --git a/drivers/common/cnxk/roc_bphy_irq.c b/drivers/common/cnxk/roc_bphy_irq.c
index 4b87fc8..53eb89c 100644 (file)
--- a/drivers/common/cnxk/roc_bphy_irq.c
+++ b/drivers/common/cnxk/roc_bphy_irq.c
@@ -123,7 +123,7 @@ roc_bphy_intr_fini(struct roc_bphy_irq_chip *irq_chip)
        plt_free(irq_chip);
 }
 
-void
+static void
 roc_bphy_irq_stack_remove(int cpu)
 {
        struct roc_bphy_irq_stack *curr_stack;
@@ -153,7 +153,7 @@ leave:
        pthread_mutex_unlock(&stacks_mutex);
 }
 
-void *
+static void *
 roc_bphy_irq_stack_get(int cpu)
 {
 #define ARM_STACK_ALIGNMENT (2 * sizeof(void *))
@@ -221,7 +221,7 @@ roc_bphy_intr_handler(unsigned int irq_num)
        roc_atf_ret();
 }
 
-int
+static int
 roc_bphy_irq_handler_set(struct roc_bphy_irq_chip *chip, int irq_num,
                         void (*isr)(int irq_num, void *isr_data),
                         void *isr_data)
@@ -319,7 +319,7 @@ roc_bphy_intr_available(struct roc_bphy_irq_chip *irq_chip, int irq_num)
 }
 
 int
-roc_bphy_handler_clear(struct roc_bphy_irq_chip *chip, int irq_num)
+roc_bphy_intr_clear(struct roc_bphy_irq_chip *chip, int irq_num)
 {
        roc_cpuset_t orig_cpuset, intr_cpuset;
        const struct plt_memzone *mz;
@@ -382,3 +382,41 @@ roc_bphy_handler_clear(struct roc_bphy_irq_chip *chip, int irq_num)
 
        return retval;
 }
+
+int
+roc_bphy_intr_register(struct roc_bphy_irq_chip *irq_chip,
+                      struct roc_bphy_intr *intr)
+{
+       roc_cpuset_t orig_cpuset, intr_cpuset;
+       int retval;
+       int ret;
+
+       if (!roc_bphy_intr_available(irq_chip, intr->irq_num))
+               return -ENOTSUP;
+
+       retval = pthread_getaffinity_np(pthread_self(), sizeof(orig_cpuset),
+                                       &orig_cpuset);
+       if (retval < 0) {
+               plt_err("Failed to get affinity mask");
+               return retval;
+       }
+
+       CPU_ZERO(&intr_cpuset);
+       CPU_SET(intr->cpu, &intr_cpuset);
+       retval = pthread_setaffinity_np(pthread_self(), sizeof(intr_cpuset),
+                                       &intr_cpuset);
+       if (retval < 0) {
+               plt_err("Failed to set affinity mask");
+               return retval;
+       }
+
+       ret = roc_bphy_irq_handler_set(irq_chip, intr->irq_num,
+                                      intr->intr_handler, intr->isr_data);
+
+       retval = pthread_setaffinity_np(pthread_self(), sizeof(orig_cpuset),
+                                       &orig_cpuset);
+       if (retval < 0)
+               plt_warn("Failed to restore affinity mask");
+
+       return ret;
+}