powerpc/ps3: Add a sub-match id to ps3_system_bus

Add sub match id for ps3 system bus so that two different system bus
devices can be connected to a shared device.

Signed-off-by: Masakazu Mokuno <mokuno@sm.sony.co.jp>
Signed-off-by: Geoff Levand <geoffrey.levand@am.sony.com>
Signed-off-by: Benjamin Herrenschmidt <benh@kernel.crashing.org>

2 files changed, 15 insertions, 7 deletions

diff --git a/arch/powerpc/platforms/ps3/device-init.c b/arch/powerpc/platforms/ps3/device-init.c
index 3866debfa3c4..ffdd8e963fbd 100644
--- a/arch/powerpc/platforms/ps3/device-init.c
+++ b/arch/powerpc/platforms/ps3/device-init.c
@@ -486,6 +486,7 @@ static int __init ps3_register_graphics_devices(void)
                 return -ENOMEM;
 
         p->dev.match_id = PS3_MATCH_ID_GRAPHICS;
+        p->dev.match_sub_id = PS3_MATCH_SUB_ID_FB;
         p->dev.dev_type = PS3_DEVICE_TYPE_IOC0;
 
         result = ps3_system_bus_device_register(&p->dev);
diff --git a/arch/powerpc/platforms/ps3/system-bus.c b/arch/powerpc/platforms/ps3/system-bus.c
index d66c3628a112..280ee88cb0b0 100644
--- a/arch/powerpc/platforms/ps3/system-bus.c
+++ b/arch/powerpc/platforms/ps3/system-bus.c
@@ -347,16 +347,23 @@ static int ps3_system_bus_match(struct device *_dev,
         struct ps3_system_bus_driver *drv = ps3_drv_to_system_bus_drv(_drv);
         struct ps3_system_bus_device *dev = ps3_dev_to_system_bus_dev(_dev);
 
-        result = dev->match_id == drv->match_id;
+        if (!dev->match_sub_id)
+                result = dev->match_id == drv->match_id;
+        else
+                result = dev->match_sub_id == drv->match_sub_id &&
+                        dev->match_id == drv->match_id;
 
         if (result)
-                pr_info("%s:%d: dev=%u(%s), drv=%u(%s): match\n", __func__,
-                        __LINE__, dev->match_id, dev->core.bus_id,
-                        drv->match_id, drv->core.name);
+                pr_info("%s:%d: dev=%u.%u(%s), drv=%u.%u(%s): match\n",
+                        __func__, __LINE__,
+                        dev->match_id, dev->match_sub_id, dev->core.bus_id,
+                        drv->match_id, drv->match_sub_id, drv->core.name);
         else
-                pr_debug("%s:%d: dev=%u(%s), drv=%u(%s): miss\n", __func__,
-                        __LINE__, dev->match_id, dev->core.bus_id,
-                        drv->match_id, drv->core.name);
+                pr_debug("%s:%d: dev=%u.%u(%s), drv=%u.%u(%s): miss\n",
+                        __func__, __LINE__,
+                        dev->match_id, dev->match_sub_id, dev->core.bus_id,
+                        drv->match_id, drv->match_sub_id, drv->core.name);
+
         return result;
 }