arch/arm/mach-keystone/keystone.c

   1 /*
   2  * Keystone2 based boards and SOC related code.
   3  *
   4  * Copyright 2013 Texas Instruments, Inc.
   5  *      Cyril Chemparathy <cyril@ti.com>
   6  *      Santosh Shilimkar <santosh.shillimkar@ti.com>
   7  *
   8  * This program is free software; you can redistribute it and/or modify it
   9  * under the terms and conditions of the GNU General Public License,
  10  * version 2, as published by the Free Software Foundation.
  11  */
  12 #include <linux/io.h>
  13 #include <linux/of.h>
  14 #include <linux/init.h>
  15 #include <linux/of_platform.h>
  16 #include <linux/of_address.h>
  17 #include <linux/memblock.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/smp_plat.h>
  24 #include <asm/memory.h>
  25
  26 #include "memory.h"
  27
  28 #include "keystone.h"
  29
  30 static unsigned long keystone_dma_pfn_offset __read_mostly;
  31
  32 static int keystone_platform_notifier(struct notifier_block *nb,
  33                                       unsigned long event, void *data)
  34 {
  35         struct device *dev = data;
  36
  37         if (event != BUS_NOTIFY_ADD_DEVICE)
  38                 return NOTIFY_DONE;
  39
  40         if (!dev)
  41                 return NOTIFY_BAD;
  42
  43         if (!dev->of_node) {
  44                 dev->dma_pfn_offset = keystone_dma_pfn_offset;
  45                 dev_err(dev, "set dma_pfn_offset%08lx\n",
  46                         dev->dma_pfn_offset);
  47         }
  48         return NOTIFY_OK;
  49 }
  50
  51 static struct notifier_block platform_nb = {
  52         .notifier_call = keystone_platform_notifier,
  53 };
  54
  55 static void __init keystone_init(void)
  56 {
  57         if (PHYS_OFFSET >= KEYSTONE_HIGH_PHYS_START) {
  58                 keystone_dma_pfn_offset = PFN_DOWN(KEYSTONE_HIGH_PHYS_START -
  59                                                    KEYSTONE_LOW_PHYS_START);
  60                 bus_register_notifier(&platform_bus_type, &platform_nb);
  61         }
  62         keystone_pm_runtime_init();
  63         of_platform_populate(NULL, of_default_bus_match_table, NULL, NULL);
  64 }
  65
  66 static phys_addr_t keystone_virt_to_idmap(unsigned long x)
  67 {
  68         return (phys_addr_t)(x) - CONFIG_PAGE_OFFSET + KEYSTONE_LOW_PHYS_START;
  69 }
  70
  71 static long long __init keystone_pv_fixup(void)
  72 {
  73         long long offset;
  74         phys_addr_t mem_start, mem_end;
  75
  76         mem_start = memblock_start_of_DRAM();
  77         mem_end = memblock_end_of_DRAM();
  78
  79         /* nothing to do if we are running out of the <32-bit space */
  80         if (mem_start >= KEYSTONE_LOW_PHYS_START &&
  81             mem_end   <= KEYSTONE_LOW_PHYS_END)
  82                 return 0;
  83
  84         if (mem_start < KEYSTONE_HIGH_PHYS_START ||
  85             mem_end   > KEYSTONE_HIGH_PHYS_END) {
  86                 pr_crit("Invalid address space for memory (%08llx-%08llx)\n",
  87                         (u64)mem_start, (u64)mem_end);
  88                 return 0;
  89         }
  90
  91         offset = KEYSTONE_HIGH_PHYS_START - KEYSTONE_LOW_PHYS_START;
  92
  93         /* Populate the arch idmap hook */
  94         arch_virt_to_idmap = keystone_virt_to_idmap;
  95
  96         return offset;
  97 }
  98
  99 static const char *const keystone_match[] __initconst = {
 100         "ti,k2hk",
 101         "ti,k2e",
 102         "ti,k2l",
 103         "ti,keystone",
 104         NULL,
 105 };
 106
 107 DT_MACHINE_START(KEYSTONE, "Keystone")
 108 #if defined(CONFIG_ZONE_DMA) && defined(CONFIG_ARM_LPAE)
 109         .dma_zone_size  = SZ_2G,
 110 #endif
 111         .smp            = smp_ops(keystone_smp_ops),
 112         .init_machine   = keystone_init,
 113         .dt_compat      = keystone_match,
 114         .pv_fixup       = keystone_pv_fixup,
 115 MACHINE_END