arch/arm/mach-keystone/keystone.c

   1 // SPDX-License-Identifier: GPL-2.0-only
   2 /*
   3  * Keystone2 based boards and SOC related code.
   4  *
   5  * Copyright 2013 Texas Instruments, Inc.
   6  *      Cyril Chemparathy <[email protected]>
   7  *      Santosh Shilimkar <[email protected]>
   8  */
   9
  10 #include <linux/io.h>
  11 #include <linux/dma-map-ops.h>
  12 #include <linux/init.h>
  13 #include <linux/pm_runtime.h>
  14 #include <linux/pm_clock.h>
  15 #include <linux/memblock.h>
  16 #include <linux/of.h>
  17 #include <linux/platform_device.h>
  18
  19 #include <asm/setup.h>
  20 #include <asm/mach/map.h>
  21 #include <asm/mach/arch.h>
  22 #include <asm/mach/time.h>
  23 #include <asm/page.h>
  24
  25 #define KEYSTONE_LOW_PHYS_START         0x80000000ULL
  26 #define KEYSTONE_LOW_PHYS_SIZE          0x80000000ULL /* 2G */
  27 #define KEYSTONE_LOW_PHYS_END           (KEYSTONE_LOW_PHYS_START + \
  28                                          KEYSTONE_LOW_PHYS_SIZE - 1)
  29
  30 #define KEYSTONE_HIGH_PHYS_START        0x800000000ULL
  31 #define KEYSTONE_HIGH_PHYS_SIZE         0x400000000ULL  /* 16G */
  32 #define KEYSTONE_HIGH_PHYS_END          (KEYSTONE_HIGH_PHYS_START + \
  33                                          KEYSTONE_HIGH_PHYS_SIZE - 1)
  34
  35 static struct dev_pm_domain keystone_pm_domain = {
  36         .ops = {
  37                 USE_PM_CLK_RUNTIME_OPS
  38                 USE_PLATFORM_PM_SLEEP_OPS
  39         },
  40 };
  41
  42 static struct pm_clk_notifier_block platform_domain_notifier = {
  43         .pm_domain = &keystone_pm_domain,
  44         .con_ids = { NULL },
  45 };
  46
  47 static const struct of_device_id of_keystone_table[] = {
  48         {.compatible = "ti,k2hk"},
  49         {.compatible = "ti,k2e"},
  50         {.compatible = "ti,k2l"},
  51         { /* end of list */ },
  52 };
  53
  54 static int __init keystone_pm_runtime_init(void)
  55 {
  56         struct device_node *np;
  57
  58         np = of_find_matching_node(NULL, of_keystone_table);
  59         if (!np)
  60                 return 0;
  61
  62         pm_clk_add_notifier(&platform_bus_type, &platform_domain_notifier);
  63
  64         return 0;
  65 }
  66
  67 #ifdef CONFIG_ARM_LPAE
  68 static int keystone_platform_notifier(struct notifier_block *nb,
  69                                       unsigned long event, void *data)
  70 {
  71         struct device *dev = data;
  72
  73         if (event != BUS_NOTIFY_ADD_DEVICE)
  74                 return NOTIFY_DONE;
  75
  76         if (!dev)
  77                 return NOTIFY_BAD;
  78
  79         if (!dev->of_node) {
  80                 int ret = dma_direct_set_offset(dev, KEYSTONE_HIGH_PHYS_START,
  81                                                 KEYSTONE_LOW_PHYS_START,
  82                                                 KEYSTONE_HIGH_PHYS_SIZE);
  83                 dev_err(dev, "set dma_offset%08llx%s\n",
  84                         KEYSTONE_HIGH_PHYS_START - KEYSTONE_LOW_PHYS_START,
  85                         ret ? " failed" : "");
  86         }
  87         return NOTIFY_OK;
  88 }
  89
  90 static struct notifier_block platform_nb = {
  91         .notifier_call = keystone_platform_notifier,
  92 };
  93 #endif /* CONFIG_ARM_LPAE */
  94
  95 static void __init keystone_init(void)
  96 {
  97 #ifdef CONFIG_ARM_LPAE
  98         if (PHYS_OFFSET >= KEYSTONE_HIGH_PHYS_START)
  99                 bus_register_notifier(&platform_bus_type, &platform_nb);
 100 #endif
 101         keystone_pm_runtime_init();
 102 }
 103
 104 static long long __init keystone_pv_fixup(void)
 105 {
 106         long long offset;
 107         u64 mem_start, mem_end;
 108
 109         mem_start = memblock_start_of_DRAM();
 110         mem_end = memblock_end_of_DRAM();
 111
 112         /* nothing to do if we are running out of the <32-bit space */
 113         if (mem_start >= KEYSTONE_LOW_PHYS_START &&
 114             mem_end   <= KEYSTONE_LOW_PHYS_END)
 115                 return 0;
 116
 117         if (mem_start < KEYSTONE_HIGH_PHYS_START ||
 118             mem_end   > KEYSTONE_HIGH_PHYS_END) {
 119                 pr_crit("Invalid address space for memory (%08llx-%08llx)\n",
 120                         mem_start, mem_end);
 121                 return 0;
 122         }
 123
 124         offset = KEYSTONE_HIGH_PHYS_START - KEYSTONE_LOW_PHYS_START;
 125
 126         /* Populate the arch idmap hook */
 127         arch_phys_to_idmap_offset = -offset;
 128
 129         return offset;
 130 }
 131
 132 static const char *const keystone_match[] __initconst = {
 133         "ti,k2hk",
 134         "ti,k2e",
 135         "ti,k2l",
 136         "ti,k2g",
 137         "ti,keystone",
 138         NULL,
 139 };
 140
 141 DT_MACHINE_START(KEYSTONE, "Keystone")
 142 #if defined(CONFIG_ZONE_DMA) && defined(CONFIG_ARM_LPAE)
 143         .dma_zone_size  = SZ_2G,
 144 #endif
 145         .init_machine   = keystone_init,
 146         .dt_compat      = keystone_match,
 147         .pv_fixup       = keystone_pv_fixup,
 148 MACHINE_END