@@ -29,6 +29,7 @@ enum ppc_dbell {
extern void doorbell_message_pass(int target, int msg);
extern void doorbell_exception(struct pt_regs *regs);
+extern void doorbell_check_self(void);
extern void doorbell_setup_this_cpu(void);
static inline void ppc_msgsnd(enum ppc_dbell type, u32 flags, u32 tag)
@@ -81,6 +81,16 @@ 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)
{
@@ -156,8 +156,8 @@ notrace void raw_local_irq_restore(unsigned long en)
return;
#if defined(CONFIG_BOOKE) && defined(CONFIG_SMP)
- /* Check for pending doorbell interrupts on SMP */
- doorbell_exception(NULL);
+ /* Check for pending doorbell interrupts and resend to ourself */
+ doorbell_check_self();
#endif
/*