highbank.c 5.4 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17
/*
 * Copyright 2010-2011 Calxeda, Inc.
 *
 * 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.
 *
 * This program is distributed in the hope it will be useful, but WITHOUT
 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
 * FITNESS FOR A PARTICULAR PURPOSE.  See the GNU General Public License for
 * more details.
 *
 * You should have received a copy of the GNU General Public License along with
 * this program.  If not, see <http://www.gnu.org/licenses/>.
 */
#include <linux/clk.h>
#include <linux/clkdev.h>
18
#include <linux/dma-mapping.h>
19 20 21 22 23 24 25
#include <linux/io.h>
#include <linux/irq.h>
#include <linux/irqdomain.h>
#include <linux/of.h>
#include <linux/of_irq.h>
#include <linux/of_platform.h>
#include <linux/of_address.h>
26
#include <linux/smp.h>
27
#include <linux/amba/bus.h>
28

29
#include <asm/arch_timer.h>
30
#include <asm/cacheflush.h>
31
#include <asm/smp_plat.h>
32
#include <asm/smp_twd.h>
33 34 35 36 37 38 39 40 41 42 43
#include <asm/hardware/arm_timer.h>
#include <asm/hardware/timer-sp.h>
#include <asm/hardware/gic.h>
#include <asm/hardware/cache-l2x0.h>
#include <asm/mach/arch.h>
#include <asm/mach/time.h>

#include "core.h"
#include "sysregs.h"

void __iomem *sregs_base;
44
void __iomem *scu_base_addr;
45 46 47 48 49 50 51 52

static void __init highbank_scu_map_io(void)
{
	unsigned long base;

	/* Get SCU base */
	asm("mrc p15, 4, %0, c15, c0, 0" : "=r" (base));

53
	scu_base_addr = ioremap(base, SZ_4K);
54 55 56 57 58 59 60 61 62 63 64 65
}

static void __init highbank_map_io(void)
{
	highbank_lluart_map_io();
}

#define HB_JUMP_TABLE_PHYS(cpu)		(0x40 + (0x10 * (cpu)))
#define HB_JUMP_TABLE_VIRT(cpu)		phys_to_virt(HB_JUMP_TABLE_PHYS(cpu))

void highbank_set_cpu_jump(int cpu, void *jump_addr)
{
66
	cpu = cpu_logical_map(cpu);
67
	writel(virt_to_phys(jump_addr), HB_JUMP_TABLE_VIRT(cpu));
68 69 70 71 72 73
	__cpuc_flush_dcache_area(HB_JUMP_TABLE_VIRT(cpu), 16);
	outer_clean_range(HB_JUMP_TABLE_PHYS(cpu),
			  HB_JUMP_TABLE_PHYS(cpu) + 15);
}

const static struct of_device_id irq_match[] = {
74
	{ .compatible = "arm,cortex-a15-gic", .data = gic_of_init, },
75 76 77 78
	{ .compatible = "arm,cortex-a9-gic", .data = gic_of_init, },
	{}
};

79 80 81 82 83 84 85 86
#ifdef CONFIG_CACHE_L2X0
static void highbank_l2x0_disable(void)
{
	/* Disable PL310 L2 Cache controller */
	highbank_smc1(0x102, 0x0);
}
#endif

87 88 89
static void __init highbank_init_irq(void)
{
	of_irq_init(irq_match);
90

91 92 93
	if (of_find_compatible_node(NULL, NULL, "arm,cortex-a9"))
		highbank_scu_map_io();

94 95 96
#ifdef CONFIG_CACHE_L2X0
	/* Enable PL310 L2 Cache controller */
	highbank_smc1(0x102, 0x1);
97
	l2x0_of_init(0, ~0UL);
98 99
	outer_cache.disable = highbank_l2x0_disable;
#endif
100 101
}

R
Rob Herring 已提交
102 103 104 105 106
static struct clk_lookup lookup = {
	.dev_id = "sp804",
	.con_id = NULL,
};

107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123
static void __init highbank_timer_init(void)
{
	int irq;
	struct device_node *np;
	void __iomem *timer_base;

	/* Map system registers */
	np = of_find_compatible_node(NULL, NULL, "calxeda,hb-sregs");
	sregs_base = of_iomap(np, 0);
	WARN_ON(!sregs_base);

	np = of_find_compatible_node(NULL, NULL, "arm,sp804");
	timer_base = of_iomap(np, 0);
	WARN_ON(!timer_base);
	irq = irq_of_parse_and_map(np, 0);

	highbank_clocks_init();
R
Rob Herring 已提交
124 125
	lookup.clk = of_clk_get(np, 0);
	clkdev_add(&lookup);
126

127
	sp804_clocksource_and_sched_clock_init(timer_base + 0x20, "timer1");
128
	sp804_clockevents_init(timer_base, irq, "timer0");
129 130

	twd_local_timer_of_register();
131 132 133

	arch_timer_of_register();
	arch_timer_sched_clock_init();
134 135 136 137 138 139 140 141 142 143 144 145 146 147
}

static struct sys_timer highbank_timer = {
	.init = highbank_timer_init,
};

static void highbank_power_off(void)
{
	hignbank_set_pwr_shutdown();

	while (1)
		cpu_do_idle();
}

148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194
static int highbank_platform_notifier(struct notifier_block *nb,
				  unsigned long event, void *__dev)
{
	struct resource *res;
	int reg = -1;
	struct device *dev = __dev;

	if (event != BUS_NOTIFY_ADD_DEVICE)
		return NOTIFY_DONE;

	if (of_device_is_compatible(dev->of_node, "calxeda,hb-ahci"))
		reg = 0xc;
	else if (of_device_is_compatible(dev->of_node, "calxeda,hb-sdhci"))
		reg = 0x18;
	else if (of_device_is_compatible(dev->of_node, "arm,pl330"))
		reg = 0x20;
	else if (of_device_is_compatible(dev->of_node, "calxeda,hb-xgmac")) {
		res = platform_get_resource(to_platform_device(dev),
					    IORESOURCE_MEM, 0);
		if (res) {
			if (res->start == 0xfff50000)
				reg = 0;
			else if (res->start == 0xfff51000)
				reg = 4;
		}
	}

	if (reg < 0)
		return NOTIFY_DONE;

	if (of_property_read_bool(dev->of_node, "dma-coherent")) {
		writel(0xff31, sregs_base + reg);
		set_dma_ops(dev, &arm_coherent_dma_ops);
	} else
		writel(0, sregs_base + reg);

	return NOTIFY_OK;
}

static struct notifier_block highbank_amba_nb = {
	.notifier_call = highbank_platform_notifier,
};

static struct notifier_block highbank_platform_nb = {
	.notifier_call = highbank_platform_notifier,
};

195 196 197
static void __init highbank_init(void)
{
	pm_power_off = highbank_power_off;
198
	highbank_pm_init();
199

200 201 202
	bus_register_notifier(&platform_bus_type, &highbank_platform_nb);
	bus_register_notifier(&amba_bustype, &highbank_amba_nb);

203 204 205 206 207
	of_platform_populate(NULL, of_default_bus_match_table, NULL, NULL);
}

static const char *highbank_match[] __initconst = {
	"calxeda,highbank",
208
	"calxeda,ecx-2000",
209 210 211 212
	NULL,
};

DT_MACHINE_START(HIGHBANK, "Highbank")
213
	.smp		= smp_ops(highbank_smp_ops),
214 215 216
	.map_io		= highbank_map_io,
	.init_irq	= highbank_init_irq,
	.timer		= &highbank_timer,
217
	.handle_irq	= gic_handle_irq,
218 219
	.init_machine	= highbank_init,
	.dt_compat	= highbank_match,
220
	.restart	= highbank_restart,
221
MACHINE_END