30b5f4d612
We ideally want the init_meminfo function to do nothing but return the delta to be applied to PHYS_OFFSET - it should do nothing else. As we can detect in platform init code whether we are running in the high physical address space, move the platform notifier initialisation entirely into the platform init code. Acked-by: Santosh Shilimkar <ssantosh@kernel.org> Tested-by: Murali Karicheri <m-karicheri2@ti.com> Signed-off-by: Russell King <rmk+kernel@arm.linux.org.uk>
123 lines
3.3 KiB
C
123 lines
3.3 KiB
C
/*
|
|
* Keystone2 based boards and SOC related code.
|
|
*
|
|
* Copyright 2013 Texas Instruments, Inc.
|
|
* Cyril Chemparathy <cyril@ti.com>
|
|
* Santosh Shilimkar <santosh.shillimkar@ti.com>
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify it
|
|
* under the terms and conditions of the GNU General Public License,
|
|
* version 2, as published by the Free Software Foundation.
|
|
*/
|
|
#include <linux/io.h>
|
|
#include <linux/of.h>
|
|
#include <linux/init.h>
|
|
#include <linux/of_platform.h>
|
|
#include <linux/of_address.h>
|
|
#include <linux/memblock.h>
|
|
|
|
#include <asm/setup.h>
|
|
#include <asm/mach/map.h>
|
|
#include <asm/mach/arch.h>
|
|
#include <asm/mach/time.h>
|
|
#include <asm/smp_plat.h>
|
|
#include <asm/memory.h>
|
|
|
|
#include "memory.h"
|
|
|
|
#include "keystone.h"
|
|
|
|
static unsigned long keystone_dma_pfn_offset __read_mostly;
|
|
|
|
static int keystone_platform_notifier(struct notifier_block *nb,
|
|
unsigned long event, void *data)
|
|
{
|
|
struct device *dev = data;
|
|
|
|
if (event != BUS_NOTIFY_ADD_DEVICE)
|
|
return NOTIFY_DONE;
|
|
|
|
if (!dev)
|
|
return NOTIFY_BAD;
|
|
|
|
if (!dev->of_node) {
|
|
dev->dma_pfn_offset = keystone_dma_pfn_offset;
|
|
dev_err(dev, "set dma_pfn_offset%08lx\n",
|
|
dev->dma_pfn_offset);
|
|
}
|
|
return NOTIFY_OK;
|
|
}
|
|
|
|
static struct notifier_block platform_nb = {
|
|
.notifier_call = keystone_platform_notifier,
|
|
};
|
|
|
|
static void __init keystone_init(void)
|
|
{
|
|
if (PHYS_OFFSET >= KEYSTONE_HIGH_PHYS_START) {
|
|
keystone_dma_pfn_offset = PFN_DOWN(KEYSTONE_HIGH_PHYS_START -
|
|
KEYSTONE_LOW_PHYS_START);
|
|
bus_register_notifier(&platform_bus_type, &platform_nb);
|
|
}
|
|
keystone_pm_runtime_init();
|
|
of_platform_populate(NULL, of_default_bus_match_table, NULL, NULL);
|
|
}
|
|
|
|
static phys_addr_t keystone_virt_to_idmap(unsigned long x)
|
|
{
|
|
return (phys_addr_t)(x) - CONFIG_PAGE_OFFSET + KEYSTONE_LOW_PHYS_START;
|
|
}
|
|
|
|
static void __init keystone_init_meminfo(void)
|
|
{
|
|
bool lpae = IS_ENABLED(CONFIG_ARM_LPAE);
|
|
bool pvpatch = IS_ENABLED(CONFIG_ARM_PATCH_PHYS_VIRT);
|
|
phys_addr_t offset = PHYS_OFFSET - KEYSTONE_LOW_PHYS_START;
|
|
phys_addr_t mem_start, mem_end;
|
|
|
|
mem_start = memblock_start_of_DRAM();
|
|
mem_end = memblock_end_of_DRAM();
|
|
|
|
/* nothing to do if we are running out of the <32-bit space */
|
|
if (mem_start >= KEYSTONE_LOW_PHYS_START &&
|
|
mem_end <= KEYSTONE_LOW_PHYS_END)
|
|
return;
|
|
|
|
if (!lpae || !pvpatch) {
|
|
pr_crit("Enable %s%s%s to run outside 32-bit space\n",
|
|
!lpae ? __stringify(CONFIG_ARM_LPAE) : "",
|
|
(!lpae && !pvpatch) ? " and " : "",
|
|
!pvpatch ? __stringify(CONFIG_ARM_PATCH_PHYS_VIRT) : "");
|
|
}
|
|
|
|
if (mem_start < KEYSTONE_HIGH_PHYS_START ||
|
|
mem_end > KEYSTONE_HIGH_PHYS_END) {
|
|
pr_crit("Invalid address space for memory (%08llx-%08llx)\n",
|
|
(u64)mem_start, (u64)mem_end);
|
|
}
|
|
|
|
offset += KEYSTONE_HIGH_PHYS_START;
|
|
__pv_phys_pfn_offset = PFN_DOWN(offset);
|
|
__pv_offset = (offset - PAGE_OFFSET);
|
|
|
|
/* Populate the arch idmap hook */
|
|
arch_virt_to_idmap = keystone_virt_to_idmap;
|
|
|
|
pr_info("Switching to high address space at 0x%llx\n", (u64)offset);
|
|
}
|
|
|
|
static const char *const keystone_match[] __initconst = {
|
|
"ti,keystone",
|
|
NULL,
|
|
};
|
|
|
|
DT_MACHINE_START(KEYSTONE, "Keystone")
|
|
#if defined(CONFIG_ZONE_DMA) && defined(CONFIG_ARM_LPAE)
|
|
.dma_zone_size = SZ_2G,
|
|
#endif
|
|
.smp = smp_ops(keystone_smp_ops),
|
|
.init_machine = keystone_init,
|
|
.dt_compat = keystone_match,
|
|
.init_meminfo = keystone_init_meminfo,
|
|
MACHINE_END
|