@@ -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
@@ -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);
@@ -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
@@ -9,6 +9,8 @@
#include <asm/head.h>
#include <linux/kernel.h>
+#include <linux/kgdb.h>
+#include <linux/kdebug.h>
#include <linux/sched.h>
#include <linux/threads.h>
#include <linux/smp.h>
@@ -42,6 +44,7 @@
#include <asm/asi.h>
#include <asm/leon.h>
#include <asm/leon_amba.h>
+#include <asm/kdebug.h>
#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);
@@ -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));
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 <konrad@gaisler.com> --- 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(-)