From: hongzha1 Subject: [PATCH][wip/dovetail] cobalt/sched: init RESCHEDULE_OOB_IPI and register interrupt handler Date: Thu, 15 Oct 2020 01:02:11 -0400 Message-Id: <20201015050211.11342-1-hongzhan.chen@intel.com> List-Id: Discussions about the Xenomai project List-Unsubscribe: , List-Archive: List-Post: List-Help: List-Subscribe: , To: xenomai@xenomai.org, jan.kiszka@siemens.com create and register RESCHEDULE_OOB_IPI interrupt handler Signed-off-by: hongzha1 diff --git a/kernel/cobalt/sched.c b/kernel/cobalt/sched.c index f39becb90..1d40925b6 100644 --- a/kernel/cobalt/sched.c +++ b/kernel/cobalt/sched.c @@ -30,6 +30,13 @@ #define CREATE_TRACE_POINTS #include +struct xn_machine_cpudata { +}; + +DEFINE_PER_CPU(struct xn_machine_cpudata, xn_machine_cpudata); + +static void xnsched_destroy(struct xnsched *sched); + /** * @ingroup cobalt_core * @defgroup cobalt_core_sched Thread scheduling control @@ -224,10 +231,18 @@ static void xnsched_init(struct xnsched *sched, int cpu) #endif /* CONFIG_XENO_OPT_WATCHDOG */ } +static irqreturn_t reschedule_interrupt(int irq, void *dev_id) +{ + __xnsched_run_handler(); + + return IRQ_HANDLED; +} + void xnsched_init_all(void) { struct xnsched *sched; int cpu; + int ret; for_each_online_cpu(cpu) { sched = &per_cpu(nksched, cpu); @@ -235,12 +250,28 @@ void xnsched_init_all(void) } #ifdef CONFIG_SMP -#warning TODO /* ipipe_request_irq(&xnsched_realtime_domain, IPIPE_RESCHEDULE_IPI, (ipipe_irq_handler_t)__xnsched_run_handler, NULL, NULL);*/ + ret = __request_percpu_irq(RESCHEDULE_OOB_IPI, + reschedule_interrupt, + IRQF_OOB, + "Xenomai reschedule", + &xn_machine_cpudata); + if (ret) + goto cleanup_sched; #endif + return; + +cleanup_sched: + for_each_online_cpu(cpu) { + sched = xnsched_struct(cpu); + xnsched_destroy(sched); + } + + return; + } static void xnsched_destroy(struct xnsched *sched) @@ -264,6 +295,7 @@ void xnsched_destroy_all(void) #ifdef CONFIG_SMP #warning TODO // ipipe_free_irq(&xnsched_realtime_domain, IPIPE_RESCHEDULE_IPI); + free_percpu_irq(RESCHEDULE_OOB_IPI, &xn_machine_cpudata); #endif xnlock_get_irqsave(&nklock, s); -- 2.17.1