ARM: vf610: report soc info via soc device

The patch adds plumbing to soc device info code necessary to support
Vybrid devices. Use case in mind for this is CAAM driver, which
utilizes said API.

Signed-off-by: Andrey Smirnov <andrew.smirnov@gmail.com>
Cc: Lucas Stach <l.stach@pengutronix.de>
Cc: Chris Healy <cphealy@gmail.com>
Cc: Shawn Guo <shawnguo@kernel.org>
Cc: linux-arm-kernel@lists.infradead.org
Cc: linux-kernel@vger.kernel.org
Cc: linux-imx@nxp.com
Tested-by: Chris Healy <cphealy@gmail.com>
Reviewed-by: Fabio Estevam <festevam@gmail.com>
Signed-off-by: Shawn Guo <shawnguo@kernel.org>

diff --git a/arch/arm/mach-imx/cpu.c b/arch/arm/mach-imx/cpu.c
index 06f8d64..e3d12b2 100644 (file)
--- a/arch/arm/mach-imx/cpu.c
+++ b/arch/arm/mach-imx/cpu.c
@@ -172,6 +172,22 @@ struct device * __init imx_soc_device_init(void)
                ocotp_compat = "fsl,imx7ulp-ocotp";
                soc_id = "i.MX7ULP";
                break;
+       case MXC_CPU_VF500:
+               ocotp_compat = "fsl,vf610-ocotp";
+               soc_id = "VF500";
+               break;
+       case MXC_CPU_VF510:
+               ocotp_compat = "fsl,vf610-ocotp";
+               soc_id = "VF510";
+               break;
+       case MXC_CPU_VF600:
+               ocotp_compat = "fsl,vf610-ocotp";
+               soc_id = "VF600";
+               break;
+       case MXC_CPU_VF610:
+               ocotp_compat = "fsl,vf610-ocotp";
+               soc_id = "VF610";
+               break;
        default:
                soc_id = "Unknown";
        }

diff --git a/arch/arm/mach-imx/mach-vf610.c b/arch/arm/mach-imx/mach-vf610.c
index 9c929b0..565dc08 100644 (file)
--- a/arch/arm/mach-imx/mach-vf610.c
+++ b/arch/arm/mach-imx/mach-vf610.c
@@ -3,11 +3,63 @@
  * Copyright 2012-2013 Freescale Semiconductor, Inc.
  */
 
+#include <linux/of_address.h>
 #include <linux/of_platform.h>
+#include <linux/io.h>
+
 #include <linux/irqchip.h>
 #include <asm/mach/arch.h>
 #include <asm/hardware/cache-l2x0.h>
 
+#include "common.h"
+#include "hardware.h"
+
+#define MSCM_CPxCOUNT          0x00c
+#define MSCM_CPxCFG1           0x014
+
+static void __init vf610_detect_cpu(void)
+{
+       struct device_node *np;
+       u32 cpxcount, cpxcfg1;
+       unsigned int cpu_type;
+       void __iomem *mscm;
+
+       np = of_find_compatible_node(NULL, NULL, "fsl,vf610-mscm-cpucfg");
+       if (WARN_ON(!np))
+               return;
+
+       mscm = of_iomap(np, 0);
+       of_node_put(np);
+
+       if (WARN_ON(!mscm))
+               return;
+
+       cpxcount = readl_relaxed(mscm + MSCM_CPxCOUNT);
+       cpxcfg1  = readl_relaxed(mscm + MSCM_CPxCFG1);
+
+       iounmap(mscm);
+
+       cpu_type = cpxcount ? MXC_CPU_VF600 : MXC_CPU_VF500;
+
+       if (cpxcfg1)
+               cpu_type |= MXC_CPU_VFx10;
+
+       mxc_set_cpu_type(cpu_type);
+}
+
+static void __init vf610_init_machine(void)
+{
+       struct device *parent;
+
+       vf610_detect_cpu();
+
+       parent = imx_soc_device_init();
+       if (parent == NULL)
+               pr_warn("failed to initialize soc device\n");
+
+       of_platform_default_populate(NULL, NULL, parent);
+}
+
 static const char * const vf610_dt_compat[] __initconst = {
        "fsl,vf500",
        "fsl,vf510",
@@ -20,5 +72,6 @@ static const char * const vf610_dt_compat[] __initconst = {
 DT_MACHINE_START(VYBRID_VF610, "Freescale Vybrid VF5xx/VF6xx (Device Tree)")
        .l2c_aux_val    = 0,
        .l2c_aux_mask   = ~0,
+       .init_machine   = vf610_init_machine,
        .dt_compat      = vf610_dt_compat,
 MACHINE_END

diff --git a/arch/arm/mach-imx/mxc.h b/arch/arm/mach-imx/mxc.h
index 2bfd2d5..48e6d78 100644 (file)
--- a/arch/arm/mach-imx/mxc.h
+++ b/arch/arm/mach-imx/mxc.h
@@ -33,6 +33,12 @@
 #define MXC_CPU_IMX7D          0x72
 #define MXC_CPU_IMX7ULP                0xff
 
+#define MXC_CPU_VFx10          0x010
+#define MXC_CPU_VF500          0x500
+#define MXC_CPU_VF510          (MXC_CPU_VF500 | MXC_CPU_VFx10)
+#define MXC_CPU_VF600          0x600
+#define MXC_CPU_VF610          (MXC_CPU_VF600 | MXC_CPU_VFx10)
+
 #define IMX_DDR_TYPE_LPDDR2            1
 
 #ifndef __ASSEMBLY__