Verify compatible string against hardware.

Signed-off-by: Aleksander Jan Bajkowski <ol...@wp.pl>
Acked-by: Hauke Mehrtens <ha...@hauke-m.de>
---
 drivers/net/dsa/lantiq_gswip.c | 20 +++++++++++++++++++-
 1 file changed, 19 insertions(+), 1 deletion(-)

diff --git a/drivers/net/dsa/lantiq_gswip.c b/drivers/net/dsa/lantiq_gswip.c
index 4cab5cd26928..26d0e3bb5dea 100644
--- a/drivers/net/dsa/lantiq_gswip.c
+++ b/drivers/net/dsa/lantiq_gswip.c
@@ -1907,7 +1907,7 @@ static int gswip_gphy_fw_list(struct gswip_priv *priv,
 static int gswip_probe(struct platform_device *pdev)
 {
        struct gswip_priv *priv;
-       struct device_node *mdio_np, *gphy_fw_np;
+       struct device_node *np, *mdio_np, *gphy_fw_np;
        struct device *dev = &pdev->dev;
        int err;
        int i;
@@ -1944,6 +1944,24 @@ static int gswip_probe(struct platform_device *pdev)
        priv->dev = dev;
        version = gswip_switch_r(priv, GSWIP_VERSION);
 
+       np = dev->of_node;
+       switch (version) {
+       case GSWIP_VERSION_2_0:
+       case GSWIP_VERSION_2_1:
+               if (!of_device_is_compatible(np, "lantiq,xrx200-gswip"))
+                       return -EINVAL;
+               break;
+       case GSWIP_VERSION_2_2:
+       case GSWIP_VERSION_2_2_ETC:
+               if (!of_device_is_compatible(np, "lantiq,xrx300-gswip") &&
+                   !of_device_is_compatible(np, "lantiq,xrx330-gswip"))
+                       return -EINVAL;
+               break;
+       default:
+               dev_err(dev, "unknown GSWIP version: 0x%x", version);
+               return -ENOENT;
+       }
+
        /* bring up the mdio bus */
        gphy_fw_np = of_get_compatible_child(dev->of_node, "lantiq,gphy-fw");
        if (gphy_fw_np) {
-- 
2.20.1

Reply via email to