common.c 10.7 KB
Newer Older
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15
/*
 * arch/arm/mach-mv78xx0/common.c
 *
 * Core functions for Marvell MV78xx0 SoCs
 *
 * This file is licensed under the terms of the GNU General Public
 * License version 2.  This program is licensed "as is" without any
 * warranty of any kind, whether express or implied.
 */

#include <linux/kernel.h>
#include <linux/init.h>
#include <linux/platform_device.h>
#include <linux/serial_8250.h>
#include <linux/ata_platform.h>
16
#include <linux/clk-provider.h>
17
#include <linux/ethtool.h>
18
#include <asm/hardware/cache-feroceon-l2.h>
19 20
#include <asm/mach/map.h>
#include <asm/mach/time.h>
21 22
#include <linux/platform_data/usb-ehci-orion.h>
#include <linux/platform_data/mtd-orion_nand.h>
23
#include <plat/time.h>
24
#include <plat/common.h>
25
#include <plat/addr-map.h>
26 27
#include "mv78xx0.h"
#include "bridge-regs.h"
28 29
#include "common.h"

30
static int get_tclk(void);
31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106

/*****************************************************************************
 * Common bits
 ****************************************************************************/
int mv78xx0_core_index(void)
{
	u32 extra;

	/*
	 * Read Extra Features register.
	 */
	__asm__("mrc p15, 1, %0, c15, c1, 0" : "=r" (extra));

	return !!(extra & 0x00004000);
}

static int get_hclk(void)
{
	int hclk;

	/*
	 * HCLK tick rate is configured by DEV_D[7:5] pins.
	 */
	switch ((readl(SAMPLE_AT_RESET_LOW) >> 5) & 7) {
	case 0:
		hclk = 166666667;
		break;
	case 1:
		hclk = 200000000;
		break;
	case 2:
		hclk = 266666667;
		break;
	case 3:
		hclk = 333333333;
		break;
	case 4:
		hclk = 400000000;
		break;
	default:
		panic("unknown HCLK PLL setting: %.8x\n",
			readl(SAMPLE_AT_RESET_LOW));
	}

	return hclk;
}

static void get_pclk_l2clk(int hclk, int core_index, int *pclk, int *l2clk)
{
	u32 cfg;

	/*
	 * Core #0 PCLK/L2CLK is configured by bits [13:8], core #1
	 * PCLK/L2CLK by bits [19:14].
	 */
	if (core_index == 0) {
		cfg = (readl(SAMPLE_AT_RESET_LOW) >> 8) & 0x3f;
	} else {
		cfg = (readl(SAMPLE_AT_RESET_LOW) >> 14) & 0x3f;
	}

	/*
	 * Bits [11:8] ([17:14] for core #1) configure the PCLK:HCLK
	 * ratio (1, 1.5, 2, 2.5, 3, 3.5, 4, 4.5, 5, 5.5, 6).
	 */
	*pclk = ((u64)hclk * (2 + (cfg & 0xf))) >> 1;

	/*
	 * Bits [13:12] ([19:18] for core #1) configure the PCLK:L2CLK
	 * ratio (1, 2, 3).
	 */
	*l2clk = *pclk / (((cfg >> 4) & 3) + 1);
}

static int get_tclk(void)
{
107
	int tclk_freq;
108 109 110 111 112 113

	/*
	 * TCLK tick rate is configured by DEV_A[2:0] strap pins.
	 */
	switch ((readl(SAMPLE_AT_RESET_HIGH) >> 6) & 7) {
	case 1:
114
		tclk_freq = 166666667;
115 116
		break;
	case 3:
117
		tclk_freq = 200000000;
118 119 120 121 122 123
		break;
	default:
		panic("unknown TCLK PLL setting: %.8x\n",
			readl(SAMPLE_AT_RESET_HIGH));
	}

124
	return tclk_freq;
125 126 127 128 129 130 131 132
}


/*****************************************************************************
 * I/O Address Mapping
 ****************************************************************************/
static struct map_desc mv78xx0_io_desc[] __initdata = {
	{
133
		.virtual	= (unsigned long) MV78XX0_CORE_REGS_VIRT_BASE,
134 135 136 137
		.pfn		= 0,
		.length		= MV78XX0_CORE_REGS_SIZE,
		.type		= MT_DEVICE,
	}, {
138
		.virtual	= (unsigned long) MV78XX0_REGS_VIRT_BASE,
139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163
		.pfn		= __phys_to_pfn(MV78XX0_REGS_PHYS_BASE),
		.length		= MV78XX0_REGS_SIZE,
		.type		= MT_DEVICE,
	},
};

void __init mv78xx0_map_io(void)
{
	unsigned long phys;

	/*
	 * Map the right set of per-core registers depending on
	 * which core we are running on.
	 */
	if (mv78xx0_core_index() == 0) {
		phys = MV78XX0_CORE0_REGS_PHYS_BASE;
	} else {
		phys = MV78XX0_CORE1_REGS_PHYS_BASE;
	}
	mv78xx0_io_desc[0].pfn = __phys_to_pfn(phys);

	iotable_init(mv78xx0_io_desc, ARRAY_SIZE(mv78xx0_io_desc));
}


164 165 166 167 168 169 170
/*****************************************************************************
 * CLK tree
 ****************************************************************************/
static struct clk *tclk;

static void __init clk_init(void)
{
171
	tclk = clk_register_fixed_rate(NULL, "tclk", NULL, 0, get_tclk());
172 173

	orion_clkdev_init(tclk);
174 175
}

176 177 178 179 180
/*****************************************************************************
 * EHCI
 ****************************************************************************/
void __init mv78xx0_ehci0_init(void)
{
181
	orion_ehci_init(USB0_PHYS_BASE, IRQ_MV78XX0_USB_0, EHCI_PHY_NA);
182 183 184 185 186 187 188 189
}


/*****************************************************************************
 * EHCI1
 ****************************************************************************/
void __init mv78xx0_ehci1_init(void)
{
190
	orion_ehci_1_init(USB1_PHYS_BASE, IRQ_MV78XX0_USB_1);
191 192 193 194 195 196 197 198
}


/*****************************************************************************
 * EHCI2
 ****************************************************************************/
void __init mv78xx0_ehci2_init(void)
{
199
	orion_ehci_2_init(USB2_PHYS_BASE, IRQ_MV78XX0_USB_2);
200 201 202 203 204 205 206 207
}


/*****************************************************************************
 * GE00
 ****************************************************************************/
void __init mv78xx0_ge00_init(struct mv643xx_eth_platform_data *eth_data)
{
208
	orion_ge00_init(eth_data,
209
			GE00_PHYS_BASE, IRQ_MV78XX0_GE00_SUM,
210 211
			IRQ_MV78XX0_GE_ERR,
			MV643XX_TX_CSUM_DEFAULT_LIMIT);
212 213 214 215 216 217 218 219
}


/*****************************************************************************
 * GE01
 ****************************************************************************/
void __init mv78xx0_ge01_init(struct mv643xx_eth_platform_data *eth_data)
{
220
	orion_ge01_init(eth_data,
221
			GE01_PHYS_BASE, IRQ_MV78XX0_GE01_SUM,
222 223
			NO_IRQ,
			MV643XX_TX_CSUM_DEFAULT_LIMIT);
224 225 226 227 228 229 230 231
}


/*****************************************************************************
 * GE10
 ****************************************************************************/
void __init mv78xx0_ge10_init(struct mv643xx_eth_platform_data *eth_data)
{
232 233 234 235 236 237 238 239 240 241 242 243 244
	u32 dev, rev;

	/*
	 * On the Z0, ge10 and ge11 are internally connected back
	 * to back, and not brought out.
	 */
	mv78xx0_pcie_id(&dev, &rev);
	if (dev == MV78X00_Z0_DEV_ID) {
		eth_data->phy_addr = MV643XX_ETH_PHY_NONE;
		eth_data->speed = SPEED_1000;
		eth_data->duplex = DUPLEX_FULL;
	}

245
	orion_ge10_init(eth_data,
246
			GE10_PHYS_BASE, IRQ_MV78XX0_GE10_SUM,
247
			NO_IRQ);
248 249 250 251 252 253 254 255
}


/*****************************************************************************
 * GE11
 ****************************************************************************/
void __init mv78xx0_ge11_init(struct mv643xx_eth_platform_data *eth_data)
{
256 257 258 259 260 261 262 263 264 265 266 267 268
	u32 dev, rev;

	/*
	 * On the Z0, ge10 and ge11 are internally connected back
	 * to back, and not brought out.
	 */
	mv78xx0_pcie_id(&dev, &rev);
	if (dev == MV78X00_Z0_DEV_ID) {
		eth_data->phy_addr = MV643XX_ETH_PHY_NONE;
		eth_data->speed = SPEED_1000;
		eth_data->duplex = DUPLEX_FULL;
	}

269
	orion_ge11_init(eth_data,
270
			GE11_PHYS_BASE, IRQ_MV78XX0_GE11_SUM,
271
			NO_IRQ);
272 273
}

Riku Voipio's avatar
Riku Voipio committed
274
/*****************************************************************************
275
 * I2C
Riku Voipio's avatar
Riku Voipio committed
276 277 278
 ****************************************************************************/
void __init mv78xx0_i2c_init(void)
{
279 280
	orion_i2c_init(I2C_0_PHYS_BASE, IRQ_MV78XX0_I2C_0, 8);
	orion_i2c_1_init(I2C_1_PHYS_BASE, IRQ_MV78XX0_I2C_1, 8);
Riku Voipio's avatar
Riku Voipio committed
281
}
282 283 284 285 286 287

/*****************************************************************************
 * SATA
 ****************************************************************************/
void __init mv78xx0_sata_init(struct mv_sata_platform_data *sata_data)
{
288
	orion_sata_init(sata_data, SATA_PHYS_BASE, IRQ_MV78XX0_SATA);
289 290 291 292 293 294 295 296
}


/*****************************************************************************
 * UART0
 ****************************************************************************/
void __init mv78xx0_uart0_init(void)
{
297
	orion_uart0_init(UART0_VIRT_BASE, UART0_PHYS_BASE,
298
			 IRQ_MV78XX0_UART_0, tclk);
299 300 301 302 303 304 305 306
}


/*****************************************************************************
 * UART1
 ****************************************************************************/
void __init mv78xx0_uart1_init(void)
{
307
	orion_uart1_init(UART1_VIRT_BASE, UART1_PHYS_BASE,
308
			 IRQ_MV78XX0_UART_1, tclk);
309 310 311 312 313 314 315 316
}


/*****************************************************************************
 * UART2
 ****************************************************************************/
void __init mv78xx0_uart2_init(void)
{
317
	orion_uart2_init(UART2_VIRT_BASE, UART2_PHYS_BASE,
318
			 IRQ_MV78XX0_UART_2, tclk);
319 320 321 322 323 324 325
}

/*****************************************************************************
 * UART3
 ****************************************************************************/
void __init mv78xx0_uart3_init(void)
{
326
	orion_uart3_init(UART3_VIRT_BASE, UART3_PHYS_BASE,
327
			 IRQ_MV78XX0_UART_3, tclk);
328 329 330 331 332
}

/*****************************************************************************
 * Time handling
 ****************************************************************************/
333 334 335
void __init mv78xx0_init_early(void)
{
	orion_time_set_base(TIMER_VIRT_BASE);
336 337 338 339 340 341 342 343
	if (mv78xx0_core_index() == 0)
		mvebu_mbus_init("marvell,mv78xx0-mbus",
				BRIDGE_WINS_CPU0_BASE, BRIDGE_WINS_SZ,
				DDR_WINDOW_CPU0_BASE, DDR_WINDOW_CPU_SZ);
	else
		mvebu_mbus_init("marvell,mv78xx0-mbus",
				BRIDGE_WINS_CPU1_BASE, BRIDGE_WINS_SZ,
				DDR_WINDOW_CPU1_BASE, DDR_WINDOW_CPU_SZ);
344 345
}

346
void __ref mv78xx0_timer_init(void)
347
{
348 349
	orion_time_init(BRIDGE_VIRT_BASE, BRIDGE_INT_TIMER1_CLR,
			IRQ_MV78XX0_TIMER_1, get_tclk());
350 351 352 353 354 355
}


/*****************************************************************************
 * General
 ****************************************************************************/
356 357 358 359 360 361 362 363 364 365 366 367 368 369
static char * __init mv78xx0_id(void)
{
	u32 dev, rev;

	mv78xx0_pcie_id(&dev, &rev);

	if (dev == MV78X00_Z0_DEV_ID) {
		if (rev == MV78X00_REV_Z0)
			return "MV78X00-Z0";
		else
			return "MV78X00-Rev-Unsupported";
	} else if (dev == MV78100_DEV_ID) {
		if (rev == MV78100_REV_A0)
			return "MV78100-A0";
370 371
		else if (rev == MV78100_REV_A1)
			return "MV78100-A1";
372 373 374 375 376 377 378 379 380 381 382 383
		else
			return "MV78100-Rev-Unsupported";
	} else if (dev == MV78200_DEV_ID) {
		if (rev == MV78100_REV_A0)
			return "MV78200-A0";
		else
			return "MV78200-Rev-Unsupported";
	} else {
		return "Device-Unknown";
	}
}

384 385 386 387 388 389 390 391 392 393 394 395 396 397 398 399
static int __init is_l2_writethrough(void)
{
	return !!(readl(CPU_CONTROL) & L2_WRITETHROUGH);
}

void __init mv78xx0_init(void)
{
	int core_index;
	int hclk;
	int pclk;
	int l2clk;

	core_index = mv78xx0_core_index();
	hclk = get_hclk();
	get_pclk_l2clk(hclk, core_index, &pclk, &l2clk);

400 401
	printk(KERN_INFO "%s ", mv78xx0_id());
	printk("core #%d, ", core_index);
402 403 404
	printk("PCLK = %dMHz, ", (pclk + 499999) / 1000000);
	printk("L2 = %dMHz, ", (l2clk + 499999) / 1000000);
	printk("HCLK = %dMHz, ", (hclk + 499999) / 1000000);
405
	printk("TCLK = %dMHz\n", (get_tclk() + 499999) / 1000000);
406

407 408
	if (IS_ENABLED(CONFIG_CACHE_FEROCEON_L2))
		feroceon_l2_init(is_l2_writethrough());
409 410 411

	/* Setup root of clk tree */
	clk_init();
412
}
413

414
void mv78xx0_restart(enum reboot_mode mode, const char *cmd)
415 416 417 418 419 420 421 422 423 424 425 426 427 428
{
	/*
	 * Enable soft reset to assert RSTOUTn.
	 */
	writel(SOFT_RESET_OUT_EN, RSTOUTn_MASK);

	/*
	 * Assert soft reset.
	 */
	writel(SOFT_RESET, SYSTEM_SOFT_RESET);

	while (1)
		;
}