drivers: bus: imx-weim: Add support for i.MX1/21/25/27/31/35/50/51/53

This patch adds WEIM support for all i.MX CPUs supported by the kernel.

Signed-off-by: Alexander Shiyan <shc_work@mail.ru>
Signed-off-by: Shawn Guo <shawn.guo@linaro.org>

1 files changed, 53 insertions, 16 deletions

diff --git a/drivers/bus/imx-weim.c b/drivers/bus/imx-weim.c
index dc860a411343..3ef58c8dbf11 100644
--- a/drivers/bus/imx-weim.c
+++ b/drivers/bus/imx-weim.c
@@ -12,46 +12,83 @@
 #include <linux/io.h>
 #include <linux/of_device.h>
 
+struct imx_weim_devtype {
+        unsigned int    cs_count;
+        unsigned int    cs_regs_count;
+        unsigned int    cs_stride;
+};
+
+static const struct imx_weim_devtype imx1_weim_devtype = {
+        .cs_count       = 6,
+        .cs_regs_count  = 2,
+        .cs_stride      = 0x08,
+};
+
+static const struct imx_weim_devtype imx27_weim_devtype = {
+        .cs_count       = 6,
+        .cs_regs_count  = 3,
+        .cs_stride      = 0x10,
+};
+
+static const struct imx_weim_devtype imx50_weim_devtype = {
+        .cs_count       = 4,
+        .cs_regs_count  = 6,
+        .cs_stride      = 0x18,
+};
+
+static const struct imx_weim_devtype imx51_weim_devtype = {
+        .cs_count       = 6,
+        .cs_regs_count  = 6,
+        .cs_stride      = 0x18,
+};
+
 static const struct of_device_id weim_id_table[] = {
-        { .compatible = "fsl,imx6q-weim", },
-        {}
+        /* i.MX1/21 */
+        { .compatible = "fsl,imx1-weim", .data = &imx1_weim_devtype, },
+        /* i.MX25/27/31/35 */
+        { .compatible = "fsl,imx27-weim", .data = &imx27_weim_devtype, },
+        /* i.MX50/53/6Q */
+        { .compatible = "fsl,imx50-weim", .data = &imx50_weim_devtype, },
+        { .compatible = "fsl,imx6q-weim", .data = &imx50_weim_devtype, },
+        /* i.MX51 */
+        { .compatible = "fsl,imx51-weim", .data = &imx51_weim_devtype, },
+        { }
 };
 MODULE_DEVICE_TABLE(of, weim_id_table);
 
-#define CS_TIMING_LEN 6
-#define CS_REG_RANGE  0x18
-
 /* Parse and set the timing for this device. */
-static int __init weim_timing_setup(struct device_node *np, void __iomem *base)
+static int __init weim_timing_setup(struct device_node *np, void __iomem *base,
+                                    const struct imx_weim_devtype *devtype)
 {
-        u32 value[CS_TIMING_LEN];
-        u32 cs_idx;
-        int ret;
-        int i;
+        u32 cs_idx, value[devtype->cs_regs_count];
+        int i, ret;
 
         /* get the CS index from this child node's "reg" property. */
         ret = of_property_read_u32(np, "reg", &cs_idx);
         if (ret)
                 return ret;
 
-        /* The weim has four chip selects. */
-        if (cs_idx > 3)
+        if (cs_idx >= devtype->cs_count)
                 return -EINVAL;
 
         ret = of_property_read_u32_array(np, "fsl,weim-cs-timing",
-                                        value, CS_TIMING_LEN);
+                                         value, devtype->cs_regs_count);
         if (ret)
                 return ret;
 
         /* set the timing for WEIM */
-        for (i = 0; i < CS_TIMING_LEN; i++)
-                writel(value[i], base + cs_idx * CS_REG_RANGE + i * 4);
+        for (i = 0; i < devtype->cs_regs_count; i++)
+                writel(value[i], base + cs_idx * devtype->cs_stride + i * 4);
+
         return 0;
 }
 
 static int __init weim_parse_dt(struct platform_device *pdev,
                                 void __iomem *base)
 {
+        const struct of_device_id *of_id = of_match_device(weim_id_table,
+                                                           &pdev->dev);
+        const struct imx_weim_devtype *devtype = of_id->data;
         struct device_node *child;
         int ret;
 
@@ -59,7 +96,7 @@ static int __init weim_parse_dt(struct platform_device *pdev,
                 if (!child->name)
                         continue;
 
-                ret = weim_timing_setup(child, base);
+                ret = weim_timing_setup(child, base, devtype);
                 if (ret) {
                         dev_err(&pdev->dev, "%s set timing failed.\n",
                                 child->full_name);