diff --git a/sys/arch/arm/arm32/db_interface.c b/sys/arch/arm/arm32/db_interface.c index fa7358bb9884..6835ba27b21e 100644 --- a/sys/arch/arm/arm32/db_interface.c +++ b/sys/arch/arm/arm32/db_interface.c @@ -1,4 +1,4 @@ -/* $NetBSD: db_interface.c,v 1.50 2013/12/15 09:13:47 skrll Exp $ */ +/* $NetBSD: db_interface.c,v 1.51 2014/03/28 21:54:12 matt Exp $ */ /* * Copyright (c) 1996 Scott K. Stevens @@ -35,7 +35,7 @@ */ #include -__KERNEL_RCSID(0, "$NetBSD: db_interface.c,v 1.50 2013/12/15 09:13:47 skrll Exp $"); +__KERNEL_RCSID(0, "$NetBSD: db_interface.c,v 1.51 2014/03/28 21:54:12 matt Exp $"); #include "opt_ddb.h" #include "opt_kgdb.h" @@ -45,6 +45,8 @@ __KERNEL_RCSID(0, "$NetBSD: db_interface.c,v 1.50 2013/12/15 09:13:47 skrll Exp #include #include /* just for boothowto */ #include +#include +#include #include @@ -69,7 +71,12 @@ u_int db_fetch_reg(int, db_regs_t *); int db_trapper(u_int, u_int, trapframe_t *, int); int db_active = 0; -db_regs_t ddb_regs; /* register state */ +#ifdef MULTIPROCESSOR +volatile struct cpu_info *db_onproc; +volatile struct cpu_info *db_newcpu; +#endif + + #ifdef DDB @@ -79,12 +86,23 @@ db_regs_t ddb_regs; /* register state */ int kdb_trap(int type, db_regs_t *regs) { + struct cpu_info * const ci = curcpu(); int s; switch (type) { case T_BREAKPOINT: /* breakpoint */ case -1: /* keyboard interrupt */ break; +#ifdef MULTIPROCESSOR + case -2: + /* + * We called to enter ddb from another process but by the time + * we got here, no one was in ddb. So ignore the request. + */ + if (db_onproc == NULL) + return 1; + break; +#endif default: if (db_recover != 0) { /* This will longjmp back into db_command_loop() */ @@ -95,17 +113,74 @@ kdb_trap(int type, db_regs_t *regs) /* Should switch to kdb`s own stack here. */ - ddb_regs = *regs; +#ifdef MULTIPROCESSOR + const bool is_mp_p = ncpu > 1; + if (is_mp_p) { + /* + * Try to take ownership of DDB. If we do, tell all other + * CPUs to enter DDB too. + */ + if (atomic_cas_ptr(&db_onproc, NULL, ci) == NULL) { + intr_ipi_send(NULL, IPI_DDB); + } + } + for (;;) { + if (is_mp_p) { + /* + * While we aren't the master, wait until the master + * gives control to us or exits. If it exited, we + * just exit to. Otherwise this cpu will enter DDB. + */ + membar_consumer(); + while (db_onproc != ci) { + if (db_onproc == NULL) + return 1; +#ifdef _ARM_ARCH_6 + __asm __volatile("wfe"); + membar_consumer(); +#endif + if (db_onproc == ci) { + printf("%s: switching to %s\n", + __func__, ci->ci_cpuname); + } + } + } +#endif - s = splhigh(); - db_active++; - cnpollc(true); - db_trap(type, 0/*code*/); - cnpollc(false); - db_active--; - splx(s); + s = splhigh(); + ci->ci_ddb_regs = regs; + atomic_inc_32(&db_active); + cnpollc(true); + db_trap(type, 0/*code*/); + cnpollc(false); + atomic_dec_32(&db_active); + ci->ci_ddb_regs = NULL; + splx(s); - *regs = ddb_regs; +#ifdef MULTIPROCESSOR + if (is_mp_p && db_newcpu != NULL) { + db_onproc = db_newcpu; + db_newcpu = NULL; +#ifdef _ARM_ARCH_6 + membar_producer(); + __asm __volatile("sev; sev"); +#endif + continue; + } + break; + } + + if (is_mp_p) { + /* + * We are exiting DDB so there is noone onproc. Tell + * the other CPUs to exit. + */ + db_onproc = NULL; +#ifdef _ARM_ARCH_6 + __asm __volatile("sev; sev"); +#endif + } +#endif return (1); } diff --git a/sys/arch/arm/arm32/db_machdep.c b/sys/arch/arm/arm32/db_machdep.c index 3e9c81ddd42a..7268761f2e2f 100644 --- a/sys/arch/arm/arm32/db_machdep.c +++ b/sys/arch/arm/arm32/db_machdep.c @@ -1,4 +1,4 @@ -/* $NetBSD: db_machdep.c,v 1.18 2014/03/01 05:41:39 matt Exp $ */ +/* $NetBSD: db_machdep.c,v 1.19 2014/03/28 21:54:12 matt Exp $ */ /* * Copyright (c) 1996 Mark Brinicombe @@ -28,10 +28,13 @@ * rights to redistribute these changes. */ +#include "opt_multiprocessor.h" + #include -__KERNEL_RCSID(0, "$NetBSD: db_machdep.c,v 1.18 2014/03/01 05:41:39 matt Exp $"); +__KERNEL_RCSID(0, "$NetBSD: db_machdep.c,v 1.19 2014/03/28 21:54:12 matt Exp $"); #include +#include #include #include #include @@ -44,6 +47,7 @@ __KERNEL_RCSID(0, "$NetBSD: db_machdep.c,v 1.18 2014/03/01 05:41:39 matt Exp $") #include #include #include +#include #ifdef _KERNEL static long nil; @@ -53,32 +57,48 @@ int db_access_abt_sp(const struct db_variable *, db_expr_t *, int); int db_access_irq_sp(const struct db_variable *, db_expr_t *, int); #endif +static int +ddb_reg_var(const struct db_variable *v, db_expr_t *ep, int op) +{ + KASSERT(curcpu()->ci_ddb_regs != NULL); + register_t * const rp = (register_t *)(curcpu()->ci_ddb_regs); + if (op == DB_VAR_SET) { + rp[(uintptr_t)v->valuep] = *ep; + } else { + *ep = rp[(uintptr_t)v->valuep]; + } + return 0; +} + + +#define XO(f) ((long *)(offsetof(db_regs_t, f) / sizeof(register_t))) const struct db_variable db_regs[] = { - { "spsr", (long *)&DDB_REGS->tf_spsr, FCN_NULL, NULL }, - { "r0", (long *)&DDB_REGS->tf_r0, FCN_NULL, NULL }, - { "r1", (long *)&DDB_REGS->tf_r1, FCN_NULL, NULL }, - { "r2", (long *)&DDB_REGS->tf_r2, FCN_NULL, NULL }, - { "r3", (long *)&DDB_REGS->tf_r3, FCN_NULL, NULL }, - { "r4", (long *)&DDB_REGS->tf_r4, FCN_NULL, NULL }, - { "r5", (long *)&DDB_REGS->tf_r5, FCN_NULL, NULL }, - { "r6", (long *)&DDB_REGS->tf_r6, FCN_NULL, NULL }, - { "r7", (long *)&DDB_REGS->tf_r7, FCN_NULL, NULL }, - { "r8", (long *)&DDB_REGS->tf_r8, FCN_NULL, NULL }, - { "r9", (long *)&DDB_REGS->tf_r9, FCN_NULL, NULL }, - { "r10", (long *)&DDB_REGS->tf_r10, FCN_NULL, NULL }, - { "r11", (long *)&DDB_REGS->tf_r11, FCN_NULL, NULL }, - { "r12", (long *)&DDB_REGS->tf_r12, FCN_NULL, NULL }, - { "usr_sp", (long *)&DDB_REGS->tf_usr_sp, FCN_NULL, NULL }, - { "usr_lr", (long *)&DDB_REGS->tf_usr_lr, FCN_NULL, NULL }, - { "svc_sp", (long *)&DDB_REGS->tf_svc_sp, FCN_NULL, NULL }, - { "svc_lr", (long *)&DDB_REGS->tf_svc_lr, FCN_NULL, NULL }, - { "pc", (long *)&DDB_REGS->tf_pc, FCN_NULL, NULL }, + { "spsr", XO(tf_spsr), ddb_reg_var, NULL }, + { "r0", XO(tf_r0), ddb_reg_var, NULL }, + { "r1", XO(tf_r1), ddb_reg_var, NULL }, + { "r2", XO(tf_r2), ddb_reg_var, NULL }, + { "r3", XO(tf_r3), ddb_reg_var, NULL }, + { "r4", XO(tf_r4), ddb_reg_var, NULL }, + { "r5", XO(tf_r5), ddb_reg_var, NULL }, + { "r6", XO(tf_r6), ddb_reg_var, NULL }, + { "r7", XO(tf_r7), ddb_reg_var, NULL }, + { "r8", XO(tf_r8), ddb_reg_var, NULL }, + { "r9", XO(tf_r9), ddb_reg_var, NULL }, + { "r10", XO(tf_r10), ddb_reg_var, NULL }, + { "r11", XO(tf_r11), ddb_reg_var, NULL }, + { "r12", XO(tf_r12), ddb_reg_var, NULL }, + { "usr_sp", XO(tf_usr_sp), ddb_reg_var, NULL }, + { "usr_lr", XO(tf_usr_lr), ddb_reg_var, NULL }, + { "svc_sp", XO(tf_svc_sp), ddb_reg_var, NULL }, + { "svc_lr", XO(tf_svc_lr), ddb_reg_var, NULL }, + { "pc", XO(tf_pc), ddb_reg_var, NULL }, #ifdef _KERNEL { "und_sp", &nil, db_access_und_sp, NULL }, { "abt_sp", &nil, db_access_abt_sp, NULL }, { "irq_sp", &nil, db_access_irq_sp, NULL }, #endif }; +#undef XO const struct db_variable * const db_eregs = db_regs + sizeof(db_regs)/sizeof(db_regs[0]); @@ -97,6 +117,12 @@ const struct db_command db_machine_command_table[] = { "Displays the TLB", NULL,NULL) }, #endif +#if defined(_KERNEL) && defined(MULTIPROCESSOR) + { DDB_ADD_CMD("cpu", db_switch_cpu_cmd, 0, + "switch to a different cpu", + NULL,NULL) }, +#endif + #ifdef ARM32_DB_COMMANDS ARM32_DB_COMMANDS, #endif @@ -418,3 +444,26 @@ db_show_frame_cmd(db_expr_t addr, bool have_addr, db_expr_t count, const char *m frame->tf_r12, frame->tf_usr_sp, frame->tf_usr_lr, frame->tf_pc); db_printf("slr=%08x\n", frame->tf_svc_lr); } + +#if defined(_KERNEL) && defined(MULTIPROCESSOR) +void +db_switch_cpu_cmd(db_expr_t addr, bool have_addr, db_expr_t count, const char *modif) +{ + if (addr >= maxcpus) { + db_printf("cpu %"DDB_EXPR_FMT"d out of range", addr); + return; + } + struct cpu_info *new_ci = cpu_lookup(addr); + if (new_ci == NULL) { + db_printf("cpu %"DDB_EXPR_FMT"d does not exist", addr); + return; + } + if (DDB_REGS->tf_spsr & PSR_T_bit) { + DDB_REGS->tf_pc -= 2; /* XXX */ + } else { + DDB_REGS->tf_pc -= 4; + } + db_newcpu = new_ci; + db_continue_cmd(0, false, 0, ""); +} +#endif diff --git a/sys/arch/arm/include/arm32/db_machdep.h b/sys/arch/arm/include/arm32/db_machdep.h index 574738bc2128..6375c3799b18 100644 --- a/sys/arch/arm/include/arm32/db_machdep.h +++ b/sys/arch/arm/include/arm32/db_machdep.h @@ -1,4 +1,4 @@ -/* $NetBSD: db_machdep.h,v 1.8 2014/03/01 05:28:23 matt Exp $ */ +/* $NetBSD: db_machdep.h,v 1.9 2014/03/28 21:54:12 matt Exp $ */ #ifndef _ARM32_DB_MACHDEP_H_ #define _ARM32_DB_MACHDEP_H_ @@ -10,5 +10,8 @@ void db_show_fault_cmd(db_expr_t, bool, db_expr_t, const char *); #ifdef _KERNEL void db_show_tlb_cmd(db_expr_t, bool, db_expr_t, const char *); #endif +#if defined(_KERNEL) && defined(MULTIPROCESSOR) +void db_switch_cpu_cmd(db_expr_t, bool, db_expr_t, const char *); +#endif #endif diff --git a/sys/arch/arm/include/db_machdep.h b/sys/arch/arm/include/db_machdep.h index 756832afed43..bf39de8bb54e 100644 --- a/sys/arch/arm/include/db_machdep.h +++ b/sys/arch/arm/include/db_machdep.h @@ -1,4 +1,4 @@ -/* $NetBSD: db_machdep.h,v 1.19 2014/03/05 16:33:33 matt Exp $ */ +/* $NetBSD: db_machdep.h,v 1.20 2014/03/28 21:54:12 matt Exp $ */ /* * Copyright (c) 1996 Scott K Stevens @@ -48,8 +48,7 @@ typedef long db_expr_t; /* expression - signed */ typedef trapframe_t db_regs_t; -extern db_regs_t ddb_regs; /* register state */ -#define DDB_REGS (&ddb_regs) +#define DDB_REGS (curcpu()->ci_ddb_regs) #ifdef __PROG26 #define PC_REGS(regs) ((regs)->tf_r15 & R15_PC) @@ -127,4 +126,9 @@ typedef register_t kgdb_reg_t; #define KGDB_REGNUM_SPSR 16 + 8*3 + 1 #define KGDB_BUFLEN 1024 +/* + * MP stuff + */ +extern volatile struct cpu_info *db_onproc; +extern volatile struct cpu_info *db_newcpu; #endif /* _ARM_DB_MACHDEP_H_ */