From patchwork Fri Sep 30 13:47:29 2011 Content-Type: text/plain; charset="utf-8" MIME-Version: 1.0 Content-Transfer-Encoding: 7bit X-Patchwork-Submitter: Konrad Eisele X-Patchwork-Id: 117146 X-Patchwork-Delegate: davem@davemloft.net Return-Path: X-Original-To: patchwork-incoming@ozlabs.org Delivered-To: patchwork-incoming@ozlabs.org Received: from vger.kernel.org (vger.kernel.org [209.132.180.67]) by ozlabs.org (Postfix) with ESMTP id 8FB35B6F82 for ; Fri, 30 Sep 2011 23:53:57 +1000 (EST) Received: (majordomo@vger.kernel.org) by vger.kernel.org via listexpand id S1757856Ab1I3Nx5 (ORCPT ); Fri, 30 Sep 2011 09:53:57 -0400 Received: from mail176c2.megamailservers.com ([69.49.111.76]:50597 "EHLO mail176c2.megamailservers.com" rhost-flags-OK-OK-OK-OK) by vger.kernel.org with ESMTP id S1757870Ab1I3Nx4 (ORCPT ); Fri, 30 Sep 2011 09:53:56 -0400 X-Authenticated-User: konrad.gaisler.com Received: from localhost.localdomain (gaisler.se [92.33.28.242]) (authenticated bits=0) by mail176c2.megamailservers.com (8.13.6/8.13.1) with ESMTP id p8UDrhNA021200; Fri, 30 Sep 2011 09:53:51 -0400 From: Konrad Eisele To: davem@davemloft.net Cc: sparclinux@vger.kernel.org, julian.calaby@gmail.com, konrad@gaisler.com Subject: [PATCH 3/4] sparc32, leon: Add support for KGDB when SMP and SPARC_LEON is enabled Date: Fri, 30 Sep 2011 15:47:29 +0200 Message-Id: <1317390450-5982-4-git-send-email-konrad@gaisler.com> X-Mailer: git-send-email 1.6.4.1 In-Reply-To: <1317390450-5982-1-git-send-email-konrad@gaisler.com> References: <1317390450-5982-1-git-send-email-konrad@gaisler.com> X-CSC: 0 X-CHA: v=1.1 cv=2Gf4Xu/7czTJIpW45n6TwY/zr/fxhY4s3JkmIjrDDIY= c=1 sm=1 a=7IBqt7sRKpAA:10 a=U62ajLuCel8A:10 a=jXKJviUpWSOlMmIvGrHOfw==:17 a=ebG-ZW-8AAAA:8 a=MG9Otw9hJ-60gX-k7aIA:9 a=uTBDWRznKjSfDgkGbUUA:7 a=cCYF7-FHeg4A:10 a=jXKJviUpWSOlMmIvGrHOfw==:117 Sender: sparclinux-owner@vger.kernel.org Precedence: bulk List-ID: X-Mailing-List: sparclinux@vger.kernel.org This patch enables KGDB support when SMP is enabled. The smp kgdb_roundup_cpus function is currently only implemented for SPARC_LEON, however if !SPARC_LEON && SMP is enabled then KGDB will be disabled. Signed-off-by: Konrad Eisele --- arch/sparc/Kconfig | 2 +- arch/sparc/include/asm/smp_32.h | 3 +++ arch/sparc/kernel/entry.S | 2 +- arch/sparc/kernel/leon_smp.c | 31 +++++++++++++++++++++++++++++-- arch/sparc/kernel/smp_32.c | 14 ++++++++++++++ 5 files changed, 48 insertions(+), 4 deletions(-) diff --git a/arch/sparc/Kconfig b/arch/sparc/Kconfig index 253986b..94e07f7 100644 --- a/arch/sparc/Kconfig +++ b/arch/sparc/Kconfig @@ -16,7 +16,7 @@ config SPARC select OF_PROMTREE select HAVE_IDE select HAVE_OPROFILE - select HAVE_ARCH_KGDB if !SMP || SPARC64 + select HAVE_ARCH_KGDB if !SMP || SPARC64 || SPARC_LEON select HAVE_ARCH_TRACEHOOK select ARCH_WANT_OPTIONAL_GPIOLIB select RTC_CLASS diff --git a/arch/sparc/include/asm/smp_32.h b/arch/sparc/include/asm/smp_32.h index 093f108..f8fe5c1 100644 --- a/arch/sparc/include/asm/smp_32.h +++ b/arch/sparc/include/asm/smp_32.h @@ -60,6 +60,9 @@ void smp_info(struct seq_file *); BTFIXUPDEF_CALL(void, smp_cross_call, smpfunc_t, cpumask_t, unsigned long, unsigned long, unsigned long, unsigned long) BTFIXUPDEF_CALL(int, __hard_smp_processor_id, void) +#ifdef CONFIG_KGDB +BTFIXUPDEF_CALL(void, smp_ipi_kgdbcapture, int); +#endif BTFIXUPDEF_CALL(void, smp_ipi_resched, int); BTFIXUPDEF_CALL(void, smp_ipi_single, int); BTFIXUPDEF_CALL(void, smp_ipi_mask_one, int); diff --git a/arch/sparc/kernel/entry.S b/arch/sparc/kernel/entry.S index f445e98..4c4c20f 100644 --- a/arch/sparc/kernel/entry.S +++ b/arch/sparc/kernel/entry.S @@ -433,7 +433,7 @@ smpleon_ipi: wr %g2, PSR_ET, %psr WRITE_PAUSE call leonsmp_ipi_interrupt - add %sp, STACKFRAME_SZ, %o1 ! pt_regs + add %sp, STACKFRAME_SZ, %o0 ! pt_regs wr %l0, PSR_ET, %psr WRITE_PAUSE RESTORE_ALL diff --git a/arch/sparc/kernel/leon_smp.c b/arch/sparc/kernel/leon_smp.c index fe8fb44..cfb2b58 100644 --- a/arch/sparc/kernel/leon_smp.c +++ b/arch/sparc/kernel/leon_smp.c @@ -9,6 +9,8 @@ #include #include +#include +#include #include #include #include @@ -42,6 +44,7 @@ #include #include #include +#include #include "kernel.h" @@ -306,6 +309,7 @@ struct leon_ipi_work { int single; int msk; int resched; + int kgdbcapture; }; static DEFINE_PER_CPU_SHARED_ALIGNED(struct leon_ipi_work, leon_ipi_work); @@ -340,7 +344,7 @@ static void __init leon_ipi_init(void) for_each_possible_cpu(cpu) { work = &per_cpu(leon_ipi_work, cpu); - work->single = work->msk = work->resched = 0; + work->single = work->msk = work->resched = work->kgdbcapture = 0; } } @@ -355,6 +359,19 @@ static void leon_ipi_single(int cpu) set_cpu_int(cpu, leon_ipi_irq); } +#ifdef CONFIG_KGDB +static void leon_ipi_kgdbcapture(int cpu) +{ + struct leon_ipi_work *work = &per_cpu(leon_ipi_work, cpu); + + /* Mark work */ + work->kgdbcapture = 1; + + /* Generate IRQ on the CPU */ + set_cpu_int(cpu, leon_ipi_irq); +} +#endif + static void leon_ipi_mask_one(int cpu) { struct leon_ipi_work *work = &per_cpu(leon_ipi_work, cpu); @@ -377,7 +394,7 @@ static void leon_ipi_resched(int cpu) set_cpu_int(cpu, leon_ipi_irq); } -void leonsmp_ipi_interrupt(void) +void leonsmp_ipi_interrupt(struct pt_regs *regs) { struct leon_ipi_work *work = &__get_cpu_var(leon_ipi_work); @@ -393,6 +410,13 @@ void leonsmp_ipi_interrupt(void) work->resched = 0; smp_resched_interrupt(); } + if (work->kgdbcapture) { + work->kgdbcapture = 0; +#ifdef CONFIG_KGDB + if (atomic_read(&kgdb_active) != -1) + kgdb_nmicallback(raw_smp_processor_id(), regs); +#endif + } } static struct smp_funcall { @@ -548,6 +572,9 @@ void __init leon_init_smp(void) BTFIXUPSET_CALL(smp_cross_call, leon_cross_call, BTFIXUPCALL_NORM); BTFIXUPSET_CALL(__hard_smp_processor_id, __leon_processor_id, BTFIXUPCALL_NORM); +#ifdef CONFIG_KGDB + BTFIXUPSET_CALL(smp_ipi_kgdbcapture, leon_ipi_kgdbcapture, BTFIXUPCALL_NORM); +#endif BTFIXUPSET_CALL(smp_ipi_resched, leon_ipi_resched, BTFIXUPCALL_NORM); BTFIXUPSET_CALL(smp_ipi_single, leon_ipi_single, BTFIXUPCALL_NORM); BTFIXUPSET_CALL(smp_ipi_mask_one, leon_ipi_mask_one, BTFIXUPCALL_NORM); diff --git a/arch/sparc/kernel/smp_32.c b/arch/sparc/kernel/smp_32.c index 21b1253..331902a 100644 --- a/arch/sparc/kernel/smp_32.c +++ b/arch/sparc/kernel/smp_32.c @@ -179,6 +179,20 @@ void smp_call_function_interrupt(void) irq_exit(); } +#ifdef CONFIG_KGDB +void kgdb_roundup_cpus(unsigned long flags) +{ + int i, this_cpu = smp_processor_id(); + const cpumask_t *mask = cpu_online_mask; + + for_each_cpu(i, mask) { + if (i == this_cpu || !cpu_online(i)) + continue; + BTFIXUP_CALL(smp_ipi_kgdbcapture)(i); + } +} +#endif + void smp_flush_cache_all(void) { xc0((smpfunc_t) BTFIXUP_CALL(local_flush_cache_all));