From: hongzha1 Subject: [PATCH v3 1/7][wip/dovetail] cobalt/sched: init RESCHEDULE_OOB_IPI and register interrupt handler Date: Wed, 28 Oct 2020 22:15:34 -0400 Message-Id: <20201029021540.2824-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 --- kernel/cobalt/sched.c | 38 +++++++++++++++++++++++++++++++------- 1 file changed, 31 insertions(+), 7 deletions(-) diff --git a/kernel/cobalt/sched.c b/kernel/cobalt/sched.c index f39becb90..36eff09d4 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,22 @@ 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); + } + } static void xnsched_destroy(struct xnsched *sched) @@ -262,8 +287,7 @@ void xnsched_destroy_all(void) spl_t s; #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