arch/arm/mach-clps711x/board-dt.c

   1 /*
   2  *  Author: Alexander Shiyan <shc_work@mail.ru>, 2016
   3  *
   4  * This program is free software; you can redistribute it and/or modify
   5  * it under the terms of the GNU General Public License as published by
   6  * the Free Software Foundation; either version 2 of the License, or
   7  * (at your option) any later version.
   8  */
   9
  10 #include <linux/io.h>
  11 #include <linux/of_fdt.h>
  12 #include <linux/platform_device.h>
  13 #include <linux/random.h>
  14 #include <linux/sizes.h>
  15
  16 #include <linux/mfd/syscon/clps711x.h>
  17
  18 #include <asm/system_info.h>
  19 #include <asm/system_misc.h>
  20 #include <asm/mach/arch.h>
  21 #include <asm/mach/map.h>
  22
  23 #define CLPS711X_VIRT_BASE      IOMEM(0xfeff4000)
  24 #define CLPS711X_PHYS_BASE      (0x80000000)
  25 # define SYSFLG1                (0x0140)
  26 # define HALT                   (0x0800)
  27 # define UNIQID                 (0x2440)
  28 # define RANDID0                (0x2700)
  29 # define RANDID1                (0x2704)
  30 # define RANDID2                (0x2708)
  31 # define RANDID3                (0x270c)
  32
  33 static struct map_desc clps711x_io_desc __initdata = {
  34         .virtual        = (unsigned long)CLPS711X_VIRT_BASE,
  35         .pfn            = __phys_to_pfn(CLPS711X_PHYS_BASE),
  36         .length         = 48 * SZ_1K,
  37         .type           = MT_DEVICE,
  38 };
  39
  40 static void __init clps711x_map_io(void)
  41 {
  42         iotable_init(&clps711x_io_desc, 1);
  43 }
  44
  45 static const struct resource clps711x_cpuidle_res =
  46         DEFINE_RES_MEM(CLPS711X_PHYS_BASE + HALT, SZ_128);
  47
  48 static void __init clps711x_init(void)
  49 {
  50         u32 id[5];
  51
  52         id[0] = readl(CLPS711X_VIRT_BASE + UNIQID);
  53         id[1] = readl(CLPS711X_VIRT_BASE + RANDID0);
  54         id[2] = readl(CLPS711X_VIRT_BASE + RANDID1);
  55         id[3] = readl(CLPS711X_VIRT_BASE + RANDID2);
  56         id[4] = readl(CLPS711X_VIRT_BASE + RANDID3);
  57         system_rev = SYSFLG1_VERID(readl(CLPS711X_VIRT_BASE + SYSFLG1));
  58
  59         add_device_randomness(id, sizeof(id));
  60
  61         system_serial_low = id[0];
  62
  63         platform_device_register_simple("clps711x-cpuidle", PLATFORM_DEVID_NONE,
  64                                         &clps711x_cpuidle_res, 1);
  65 }
  66
  67 static void clps711x_restart(enum reboot_mode mode, const char *cmd)
  68 {
  69         soft_restart(0);
  70 }
  71
  72 static const char *clps711x_compat[] __initconst = {
  73         "cirrus,ep7209",
  74         NULL
  75 };
  76
  77 DT_MACHINE_START(CLPS711X_DT, "Cirrus Logic CLPS711X (Device Tree Support)")
  78         .dt_compat      = clps711x_compat,
  79         .map_io         = clps711x_map_io,
  80         .init_late      = clps711x_init,
  81         .restart        = clps711x_restart,
  82 MACHINE_END