shinys000114/linux
1
0
Fork 0
mirror of https://github.com/hardkernel/linux.git synced 2026-06-10 21:07:02 +09:00
Code Issues Packages Projects Releases Wiki Activity

fiq debugger: support nmi mode

Browse Source 
Signed-off-by: Huibin Hong <huibin.hong@rock-chips.com>
Change-Id: I1c3b3591d1760eba773a7d754530e70e80118893
This commit is contained in:
Huibin Hong
2021-12-20 08:52:31 +00:00
committed by Tao Huang
parent 69622cf227
commit 58e8ae42ae
3 changed files with 25 additions and 25 deletions
Download Patch File Download Diff File Expand all files Collapse all files

12
drivers/soc/rockchip/rk_fiq_debugger.c
View File

@@ -960,13 +960,9 @@ static int __init rk_fiqdbg_probe(struct platform_device *pdev)
if (of_property_read_u32(np, "rockchip,irq-mode-enable", &irq_mode)) if (of_property_read_u32(np, "rockchip,irq-mode-enable", &irq_mode))
irq_mode = -1; irq_mode = -1;
if (irq_mode == 1) { signal_irq = irq_of_parse_and_map(np, 0);
signal_irq = -1; if (!signal_irq)
} else { return -EINVAL;
signal_irq = irq_of_parse_and_map(np, 0);
if (!signal_irq)
return -EINVAL;
}
if (of_property_read_u32(np, "rockchip,wake-irq", &wake_irq)) if (of_property_read_u32(np, "rockchip,wake-irq", &wake_irq))
wake_irq = -1; wake_irq = -1;
@@ -996,7 +992,7 @@ static int __init rk_fiqdbg_probe(struct platform_device *pdev)
} }
/* parse serial hw irq */ /* parse serial hw irq */
if (!of_irq_parse_one(np, 0, &oirq)) if (irq_mode != 1 && !of_irq_parse_one(np, 0, &oirq))
serial_hwirq = oirq.args[1] + 32; serial_hwirq = oirq.args[1] + 32;
/* parse serial phy base address */ /* parse serial phy base address */

36
drivers/staging/android/fiq_debugger/fiq_debugger.c
View File

@@ -198,13 +198,10 @@ static inline bool fiq_debugger_have_fiq(struct fiq_debugger_state *state)
return (state->fiq >= 0); return (state->fiq >= 0);
} }
#if defined(CONFIG_FIQ_GLUE) || defined(CONFIG_FIQ_DEBUGGER_TRUST_ZONE)
static void fiq_debugger_force_irq(struct fiq_debugger_state *state) static void fiq_debugger_force_irq(struct fiq_debugger_state *state)
{ {
unsigned int irq = state->signal_irq; unsigned int irq = state->signal_irq;
if (WARN_ON(!fiq_debugger_have_fiq(state)))
return;
if (irq < 0) if (irq < 0)
return; return;
@@ -217,7 +214,6 @@ static void fiq_debugger_force_irq(struct fiq_debugger_state *state)
chip->irq_retrigger(irq_get_irq_data(irq)); chip->irq_retrigger(irq_get_irq_data(irq));
} }
} }
#endif
static void fiq_debugger_uart_enable(struct fiq_debugger_state *state) static void fiq_debugger_uart_enable(struct fiq_debugger_state *state)
{ {
@@ -574,19 +570,16 @@ static void fiq_debugger_help(struct fiq_debugger_state *state)
} }
#ifndef CONFIG_FIQ_DEBUGGER_MODULE #ifndef CONFIG_FIQ_DEBUGGER_MODULE
static void fiq_debugger_take_affinity(void *info) static void fiq_debugger_take_affinity(struct fiq_debugger_state *state, int cpu)
{ {
struct fiq_debugger_state *state = info;
struct cpumask cpumask; struct cpumask cpumask;
cpumask_clear(&cpumask); cpumask_clear(&cpumask);
cpumask_set_cpu(get_cpu(), &cpumask); cpumask_set_cpu(cpu, &cpumask);
put_cpu();
irq_set_affinity(state->uart_irq, &cpumask); irq_set_affinity(state->uart_irq, &cpumask);
} }
#else #else
static void fiq_debugger_take_affinity(void *info) static void fiq_debugger_take_affinity(struct fiq_debugger_state *state, int cpu)
{ {
} }
#endif #endif
@@ -598,9 +591,9 @@ static void fiq_debugger_switch_cpu(struct fiq_debugger_state *state, int cpu)
return; return;
} }
if (!fiq_debugger_have_fiq(state)) if (!fiq_debugger_have_fiq(state)) {
smp_call_function_single(cpu, fiq_debugger_take_affinity, state, fiq_debugger_take_affinity(state, cpu);
false); }
#ifdef CONFIG_ARCH_ROCKCHIP #ifdef CONFIG_ARCH_ROCKCHIP
else { else {
#ifdef CONFIG_FIQ_DEBUGGER_TRUST_ZONE #ifdef CONFIG_FIQ_DEBUGGER_TRUST_ZONE
@@ -1113,7 +1106,7 @@ static irqreturn_t fiq_debugger_uart_irq(int irq, void *dev)
get_irq_regs(), get_irq_regs(),
current_thread_info()); current_thread_info());
if (not_done) if (not_done)
fiq_debugger_handle_irq_context(state); fiq_debugger_force_irq(state);
return IRQ_HANDLED; return IRQ_HANDLED;
} }
@@ -1518,8 +1511,19 @@ static int fiq_debugger_probe(struct platform_device *pdev)
} }
#endif #endif
} else { } else {
ret = request_irq(state->uart_irq, fiq_debugger_uart_irq, irq_set_status_flags(state->uart_irq, IRQ_NOAUTOEN);
IRQF_NO_SUSPEND, "debug", state);
ret = request_nmi(state->uart_irq, fiq_debugger_uart_irq,
IRQF_PERCPU, "debug", state);
if (ret) {
pr_err("%s: could not install nmi irq handler\n", __func__);
irq_clear_status_flags(state->uart_irq, IRQ_NOAUTOEN);
ret = request_irq(state->uart_irq, fiq_debugger_uart_irq,
IRQF_NO_SUSPEND, "debug", state);
} else {
enable_nmi(state->uart_irq);
}
if (ret) { if (ret) {
pr_err("%s: could not install irq handler\n", __func__); pr_err("%s: could not install irq handler\n", __func__);
goto err_register_irq; goto err_register_irq;

2
drivers/staging/android/fiq_debugger/fiq_debugger_arm64.c
View File

@@ -145,7 +145,7 @@ void fiq_debugger_dump_allregs(struct fiq_debugger_output *output,
READ_SPECIAL_REG(spsr_und)); READ_SPECIAL_REG(spsr_und));
output->printf(output, " spsr_fiq %08lx\n", output->printf(output, " spsr_fiq %08lx\n",
READ_SPECIAL_REG(spsr_fiq)); READ_SPECIAL_REG(spsr_fiq));
output->printf(output, " spsr_el2 %08lx\n", output->printf(output, " elr_el2 %08lx\n",
READ_SPECIAL_REG(elr_el2)); READ_SPECIAL_REG(elr_el2));
output->printf(output, " spsr_el2 %08lx\n", output->printf(output, " spsr_el2 %08lx\n",
READ_SPECIAL_REG(spsr_el2)); READ_SPECIAL_REG(spsr_el2));