arch/arm/mach-imx/mach-imx7ulp.c

   1 // SPDX-License-Identifier: GPL-2.0+
   2 /*
   3  * Copyright (C) 2016 Freescale Semiconductor, Inc.
   4  * Copyright 2017-2018 NXP
   5  *   Author: Dong Aisheng <aisheng.dong@nxp.com>
   6  */
   7
   8 #include <linux/irqchip.h>
   9 #include <linux/mfd/syscon.h>
  10 #include <linux/of_platform.h>
  11 #include <linux/regmap.h>
  12 #include <asm/mach/arch.h>
  13
  14 #include "common.h"
  15 #include "cpuidle.h"
  16 #include "hardware.h"
  17
  18 #define SIM_JTAG_ID_REG         0x8c
  19
  20 static void __init imx7ulp_set_revision(void)
  21 {
  22         struct regmap *sim;
  23         u32 revision;
  24
  25         sim = syscon_regmap_lookup_by_compatible("fsl,imx7ulp-sim");
  26         if (IS_ERR(sim)) {
  27                 pr_warn("failed to find fsl,imx7ulp-sim regmap!\n");
  28                 return;
  29         }
  30
  31         if (regmap_read(sim, SIM_JTAG_ID_REG, &revision)) {
  32                 pr_warn("failed to read sim regmap!\n");
  33                 return;
  34         }
  35
  36         /*
  37          * bit[31:28] of JTAG_ID register defines revision as below from B0:
  38          * 0001        B0
  39          * 0010        B1
  40          */
  41         switch (revision >> 28) {
  42         case 1:
  43                 imx_set_soc_revision(IMX_CHIP_REVISION_2_0);
  44                 break;
  45         case 2:
  46                 imx_set_soc_revision(IMX_CHIP_REVISION_2_1);
  47                 break;
  48         default:
  49                 imx_set_soc_revision(IMX_CHIP_REVISION_1_0);
  50                 break;
  51         }
  52 }
  53
  54 static void __init imx7ulp_init_machine(void)
  55 {
  56         imx7ulp_pm_init();
  57
  58         mxc_set_cpu_type(MXC_CPU_IMX7ULP);
  59         imx7ulp_set_revision();
  60         of_platform_default_populate(NULL, NULL, imx_soc_device_init());
  61 }
  62
  63 static const char *const imx7ulp_dt_compat[] __initconst = {
  64         "fsl,imx7ulp",
  65         NULL,
  66 };
  67
  68 static void __init imx7ulp_init_late(void)
  69 {
  70         imx7ulp_cpuidle_init();
  71 }
  72
  73 DT_MACHINE_START(IMX7ulp, "Freescale i.MX7ULP (Device Tree)")
  74         .init_machine   = imx7ulp_init_machine,
  75         .dt_compat      = imx7ulp_dt_compat,
  76         .init_late      = imx7ulp_init_late,
  77 MACHINE_END