850f22d568
If we are soft disabled and receive a doorbell exception we don't process it immediately. This means we need to check on the way out of irq restore if there are any doorbell exceptions to process. The problem is at that point we don't know what our regs are, and that in turn makes xmon unhappy. To workaround the problem, instead of checking for and processing doorbells, we check for any doorbells and if there were any we send ourselves another. Signed-off-by: Michael Ellerman <michael@ellerman.id.au> Signed-off-by: Benjamin Herrenschmidt <benh@kernel.crashing.org>
101 lines
2.3 KiB
C
101 lines
2.3 KiB
C
/*
|
|
* Author: Kumar Gala <galak@kernel.crashing.org>
|
|
*
|
|
* Copyright 2009 Freescale Semiconductor Inc.
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms of the GNU General Public License as published by the
|
|
* Free Software Foundation; either version 2 of the License, or (at your
|
|
* option) any later version.
|
|
*/
|
|
|
|
#include <linux/stddef.h>
|
|
#include <linux/kernel.h>
|
|
#include <linux/smp.h>
|
|
#include <linux/threads.h>
|
|
#include <linux/percpu.h>
|
|
|
|
#include <asm/dbell.h>
|
|
#include <asm/irq_regs.h>
|
|
|
|
#ifdef CONFIG_SMP
|
|
struct doorbell_cpu_info {
|
|
unsigned long messages; /* current messages bits */
|
|
unsigned int tag; /* tag value */
|
|
};
|
|
|
|
static DEFINE_PER_CPU(struct doorbell_cpu_info, doorbell_cpu_info);
|
|
|
|
void doorbell_setup_this_cpu(void)
|
|
{
|
|
struct doorbell_cpu_info *info = &__get_cpu_var(doorbell_cpu_info);
|
|
|
|
info->messages = 0;
|
|
info->tag = mfspr(SPRN_PIR) & 0x3fff;
|
|
}
|
|
|
|
void doorbell_message_pass(int target, int msg)
|
|
{
|
|
struct doorbell_cpu_info *info;
|
|
int i;
|
|
|
|
if (target < NR_CPUS) {
|
|
info = &per_cpu(doorbell_cpu_info, target);
|
|
set_bit(msg, &info->messages);
|
|
ppc_msgsnd(PPC_DBELL, 0, info->tag);
|
|
}
|
|
else if (target == MSG_ALL_BUT_SELF) {
|
|
for_each_online_cpu(i) {
|
|
if (i == smp_processor_id())
|
|
continue;
|
|
info = &per_cpu(doorbell_cpu_info, i);
|
|
set_bit(msg, &info->messages);
|
|
ppc_msgsnd(PPC_DBELL, 0, info->tag);
|
|
}
|
|
}
|
|
else { /* target == MSG_ALL */
|
|
for_each_online_cpu(i) {
|
|
info = &per_cpu(doorbell_cpu_info, i);
|
|
set_bit(msg, &info->messages);
|
|
}
|
|
ppc_msgsnd(PPC_DBELL, PPC_DBELL_MSG_BRDCAST, 0);
|
|
}
|
|
}
|
|
|
|
void doorbell_exception(struct pt_regs *regs)
|
|
{
|
|
struct pt_regs *old_regs = set_irq_regs(regs);
|
|
struct doorbell_cpu_info *info = &__get_cpu_var(doorbell_cpu_info);
|
|
int msg;
|
|
|
|
/* Warning: regs can be NULL when called from irq enable */
|
|
|
|
if (!info->messages || (num_online_cpus() < 2))
|
|
goto out;
|
|
|
|
for (msg = 0; msg < 4; msg++)
|
|
if (test_and_clear_bit(msg, &info->messages))
|
|
smp_message_recv(msg);
|
|
|
|
out:
|
|
set_irq_regs(old_regs);
|
|
}
|
|
|
|
void doorbell_check_self(void)
|
|
{
|
|
struct doorbell_cpu_info *info = &__get_cpu_var(doorbell_cpu_info);
|
|
|
|
if (!info->messages)
|
|
return;
|
|
|
|
ppc_msgsnd(PPC_DBELL, 0, info->tag);
|
|
}
|
|
|
|
#else /* CONFIG_SMP */
|
|
void doorbell_exception(struct pt_regs *regs)
|
|
{
|
|
printk(KERN_WARNING "Received doorbell on non-smp system\n");
|
|
}
|
|
#endif /* CONFIG_SMP */
|
|
|