rapidio: add global inbound port write interfaces

Add new Port Write handler registration interfaces that attach PW
handlers to local mport device objects.  This is different from old
interface that attaches PW callback to individual RapidIO device.  The
new interfaces are intended for use for common event handling (e.g.
hot-plug notifications) while the old interface is available for
individual device drivers.

This patch is based on patch proposed by Andre van Herk but preserves
existing per-device interface and adds lock protection for list
handling.

Signed-off-by: Alexandre Bounine <alexandre.bounine@idt.com>
Cc: Matt Porter <mporter@kernel.crashing.org>
Cc: Aurelien Jacquiot <a-jacquiot@ti.com>
Cc: Andre van Herk <andre.van.herk@prodrive-technologies.com>
Cc: Stephen Rothwell <sfr@canb.auug.org.au>
Signed-off-by: Andrew Morton <akpm@linux-foundation.org>
Signed-off-by: Linus Torvalds <torvalds@linux-foundation.org>

3 files changed, 12 insertions, 6 deletions

diff --git a/arch/powerpc/sysdev/fsl_rio.c b/arch/powerpc/sysdev/fsl_rio.c
index 385371acc0d0..f5bf38b94595 100644
--- a/arch/powerpc/sysdev/fsl_rio.c
+++ b/arch/powerpc/sysdev/fsl_rio.c
@@ -726,6 +726,7 @@ int fsl_rio_setup(struct platform_device *dev)
                 fsl_rio_inbound_mem_init(priv);
 
                 dbell->mport[i] = port;
+                pw->mport[i] = port;
 
                 if (rio_register_mport(port)) {
                         release_resource(&port->iores);
diff --git a/arch/powerpc/sysdev/fsl_rio.h b/arch/powerpc/sysdev/fsl_rio.h
index d53407a34f32..12dd18fd4795 100644
--- a/arch/powerpc/sysdev/fsl_rio.h
+++ b/arch/powerpc/sysdev/fsl_rio.h
@@ -97,6 +97,7 @@ struct fsl_rio_dbell {
 };
 
 struct fsl_rio_pw {
+        struct rio_mport *mport[MAX_PORT_NUM];
         struct device *dev;
         struct rio_pw_regs __iomem *pw_regs;
         struct rio_port_write_msg port_write_msg;
diff --git a/arch/powerpc/sysdev/fsl_rmu.c b/arch/powerpc/sysdev/fsl_rmu.c
index ffe0ee832768..c1826de4e749 100644
--- a/arch/powerpc/sysdev/fsl_rmu.c
+++ b/arch/powerpc/sysdev/fsl_rmu.c
@@ -481,14 +481,14 @@ pw_done:
 static void fsl_pw_dpc(struct work_struct *work)
 {
         struct fsl_rio_pw *pw = container_of(work, struct fsl_rio_pw, pw_work);
-        u32 msg_buffer[RIO_PW_MSG_SIZE/sizeof(u32)];
+        union rio_pw_msg msg_buffer;
+        int i;
 
         /*
          * Process port-write messages
          */
-        while (kfifo_out_spinlocked(&pw->pw_fifo, (unsigned char *)msg_buffer,
+        while (kfifo_out_spinlocked(&pw->pw_fifo, (unsigned char *)&msg_buffer,
                          RIO_PW_MSG_SIZE, &pw->pw_fifo_lock)) {
-                /* Process one message */
 #ifdef DEBUG_PW
                 {
                 u32 i;
@@ -496,15 +496,19 @@ static void fsl_pw_dpc(struct work_struct *work)
                 for (i = 0; i < RIO_PW_MSG_SIZE/sizeof(u32); i++) {
                         if ((i%4) == 0)
                                 pr_debug("\n0x%02x: 0x%08x", i*4,
-                                         msg_buffer[i]);
+                                         msg_buffer.raw[i]);
                         else
-                                pr_debug(" 0x%08x", msg_buffer[i]);
+                                pr_debug(" 0x%08x", msg_buffer.raw[i]);
                 }
                 pr_debug("\n");
                 }
 #endif
                 /* Pass the port-write message to RIO core for processing */
-                rio_inb_pwrite_handler((union rio_pw_msg *)msg_buffer);
+                for (i = 0; i < MAX_PORT_NUM; i++) {
+                        if (pw->mport[i])
+                                rio_inb_pwrite_handler(pw->mport[i],
+                                                       &msg_buffer);
+                }
         }
 }