162306a36Sopenharmony_ci// SPDX-License-Identifier: GPL-2.0-only
262306a36Sopenharmony_ci/*
362306a36Sopenharmony_ci * arch/arm/mach-mv78xx0/common.c
462306a36Sopenharmony_ci *
562306a36Sopenharmony_ci * Core functions for Marvell MV78xx0 SoCs
662306a36Sopenharmony_ci */
762306a36Sopenharmony_ci
862306a36Sopenharmony_ci#include <linux/kernel.h>
962306a36Sopenharmony_ci#include <linux/init.h>
1062306a36Sopenharmony_ci#include <linux/io.h>
1162306a36Sopenharmony_ci#include <linux/platform_device.h>
1262306a36Sopenharmony_ci#include <linux/serial_8250.h>
1362306a36Sopenharmony_ci#include <linux/ata_platform.h>
1462306a36Sopenharmony_ci#include <linux/clk-provider.h>
1562306a36Sopenharmony_ci#include <linux/ethtool.h>
1662306a36Sopenharmony_ci#include <asm/hardware/cache-feroceon-l2.h>
1762306a36Sopenharmony_ci#include <asm/mach/map.h>
1862306a36Sopenharmony_ci#include <asm/mach/time.h>
1962306a36Sopenharmony_ci#include <linux/platform_data/usb-ehci-orion.h>
2062306a36Sopenharmony_ci#include <linux/platform_data/mtd-orion_nand.h>
2162306a36Sopenharmony_ci#include <plat/time.h>
2262306a36Sopenharmony_ci#include <plat/common.h>
2362306a36Sopenharmony_ci#include <plat/addr-map.h>
2462306a36Sopenharmony_ci#include "mv78xx0.h"
2562306a36Sopenharmony_ci#include "bridge-regs.h"
2662306a36Sopenharmony_ci#include "common.h"
2762306a36Sopenharmony_ci
2862306a36Sopenharmony_cistatic int get_tclk(void);
2962306a36Sopenharmony_ci
3062306a36Sopenharmony_ci/*****************************************************************************
3162306a36Sopenharmony_ci * Common bits
3262306a36Sopenharmony_ci ****************************************************************************/
3362306a36Sopenharmony_ciint mv78xx0_core_index(void)
3462306a36Sopenharmony_ci{
3562306a36Sopenharmony_ci	u32 extra;
3662306a36Sopenharmony_ci
3762306a36Sopenharmony_ci	/*
3862306a36Sopenharmony_ci	 * Read Extra Features register.
3962306a36Sopenharmony_ci	 */
4062306a36Sopenharmony_ci	__asm__("mrc p15, 1, %0, c15, c1, 0" : "=r" (extra));
4162306a36Sopenharmony_ci
4262306a36Sopenharmony_ci	return !!(extra & 0x00004000);
4362306a36Sopenharmony_ci}
4462306a36Sopenharmony_ci
4562306a36Sopenharmony_cistatic int get_hclk(void)
4662306a36Sopenharmony_ci{
4762306a36Sopenharmony_ci	int hclk;
4862306a36Sopenharmony_ci
4962306a36Sopenharmony_ci	/*
5062306a36Sopenharmony_ci	 * HCLK tick rate is configured by DEV_D[7:5] pins.
5162306a36Sopenharmony_ci	 */
5262306a36Sopenharmony_ci	switch ((readl(SAMPLE_AT_RESET_LOW) >> 5) & 7) {
5362306a36Sopenharmony_ci	case 0:
5462306a36Sopenharmony_ci		hclk = 166666667;
5562306a36Sopenharmony_ci		break;
5662306a36Sopenharmony_ci	case 1:
5762306a36Sopenharmony_ci		hclk = 200000000;
5862306a36Sopenharmony_ci		break;
5962306a36Sopenharmony_ci	case 2:
6062306a36Sopenharmony_ci		hclk = 266666667;
6162306a36Sopenharmony_ci		break;
6262306a36Sopenharmony_ci	case 3:
6362306a36Sopenharmony_ci		hclk = 333333333;
6462306a36Sopenharmony_ci		break;
6562306a36Sopenharmony_ci	case 4:
6662306a36Sopenharmony_ci		hclk = 400000000;
6762306a36Sopenharmony_ci		break;
6862306a36Sopenharmony_ci	default:
6962306a36Sopenharmony_ci		panic("unknown HCLK PLL setting: %.8x\n",
7062306a36Sopenharmony_ci			readl(SAMPLE_AT_RESET_LOW));
7162306a36Sopenharmony_ci	}
7262306a36Sopenharmony_ci
7362306a36Sopenharmony_ci	return hclk;
7462306a36Sopenharmony_ci}
7562306a36Sopenharmony_ci
7662306a36Sopenharmony_cistatic void get_pclk_l2clk(int hclk, int core_index, int *pclk, int *l2clk)
7762306a36Sopenharmony_ci{
7862306a36Sopenharmony_ci	u32 cfg;
7962306a36Sopenharmony_ci
8062306a36Sopenharmony_ci	/*
8162306a36Sopenharmony_ci	 * Core #0 PCLK/L2CLK is configured by bits [13:8], core #1
8262306a36Sopenharmony_ci	 * PCLK/L2CLK by bits [19:14].
8362306a36Sopenharmony_ci	 */
8462306a36Sopenharmony_ci	if (core_index == 0) {
8562306a36Sopenharmony_ci		cfg = (readl(SAMPLE_AT_RESET_LOW) >> 8) & 0x3f;
8662306a36Sopenharmony_ci	} else {
8762306a36Sopenharmony_ci		cfg = (readl(SAMPLE_AT_RESET_LOW) >> 14) & 0x3f;
8862306a36Sopenharmony_ci	}
8962306a36Sopenharmony_ci
9062306a36Sopenharmony_ci	/*
9162306a36Sopenharmony_ci	 * Bits [11:8] ([17:14] for core #1) configure the PCLK:HCLK
9262306a36Sopenharmony_ci	 * ratio (1, 1.5, 2, 2.5, 3, 3.5, 4, 4.5, 5, 5.5, 6).
9362306a36Sopenharmony_ci	 */
9462306a36Sopenharmony_ci	*pclk = ((u64)hclk * (2 + (cfg & 0xf))) >> 1;
9562306a36Sopenharmony_ci
9662306a36Sopenharmony_ci	/*
9762306a36Sopenharmony_ci	 * Bits [13:12] ([19:18] for core #1) configure the PCLK:L2CLK
9862306a36Sopenharmony_ci	 * ratio (1, 2, 3).
9962306a36Sopenharmony_ci	 */
10062306a36Sopenharmony_ci	*l2clk = *pclk / (((cfg >> 4) & 3) + 1);
10162306a36Sopenharmony_ci}
10262306a36Sopenharmony_ci
10362306a36Sopenharmony_cistatic int get_tclk(void)
10462306a36Sopenharmony_ci{
10562306a36Sopenharmony_ci	int tclk_freq;
10662306a36Sopenharmony_ci
10762306a36Sopenharmony_ci	/*
10862306a36Sopenharmony_ci	 * TCLK tick rate is configured by DEV_A[2:0] strap pins.
10962306a36Sopenharmony_ci	 */
11062306a36Sopenharmony_ci	switch ((readl(SAMPLE_AT_RESET_HIGH) >> 6) & 7) {
11162306a36Sopenharmony_ci	case 1:
11262306a36Sopenharmony_ci		tclk_freq = 166666667;
11362306a36Sopenharmony_ci		break;
11462306a36Sopenharmony_ci	case 3:
11562306a36Sopenharmony_ci		tclk_freq = 200000000;
11662306a36Sopenharmony_ci		break;
11762306a36Sopenharmony_ci	default:
11862306a36Sopenharmony_ci		panic("unknown TCLK PLL setting: %.8x\n",
11962306a36Sopenharmony_ci			readl(SAMPLE_AT_RESET_HIGH));
12062306a36Sopenharmony_ci	}
12162306a36Sopenharmony_ci
12262306a36Sopenharmony_ci	return tclk_freq;
12362306a36Sopenharmony_ci}
12462306a36Sopenharmony_ci
12562306a36Sopenharmony_ci
12662306a36Sopenharmony_ci/*****************************************************************************
12762306a36Sopenharmony_ci * I/O Address Mapping
12862306a36Sopenharmony_ci ****************************************************************************/
12962306a36Sopenharmony_cistatic struct map_desc mv78xx0_io_desc[] __initdata = {
13062306a36Sopenharmony_ci	{
13162306a36Sopenharmony_ci		.virtual	= (unsigned long) MV78XX0_CORE_REGS_VIRT_BASE,
13262306a36Sopenharmony_ci		.pfn		= 0,
13362306a36Sopenharmony_ci		.length		= MV78XX0_CORE_REGS_SIZE,
13462306a36Sopenharmony_ci		.type		= MT_DEVICE,
13562306a36Sopenharmony_ci	}, {
13662306a36Sopenharmony_ci		.virtual	= (unsigned long) MV78XX0_REGS_VIRT_BASE,
13762306a36Sopenharmony_ci		.pfn		= __phys_to_pfn(MV78XX0_REGS_PHYS_BASE),
13862306a36Sopenharmony_ci		.length		= MV78XX0_REGS_SIZE,
13962306a36Sopenharmony_ci		.type		= MT_DEVICE,
14062306a36Sopenharmony_ci	},
14162306a36Sopenharmony_ci};
14262306a36Sopenharmony_ci
14362306a36Sopenharmony_civoid __init mv78xx0_map_io(void)
14462306a36Sopenharmony_ci{
14562306a36Sopenharmony_ci	unsigned long phys;
14662306a36Sopenharmony_ci
14762306a36Sopenharmony_ci	/*
14862306a36Sopenharmony_ci	 * Map the right set of per-core registers depending on
14962306a36Sopenharmony_ci	 * which core we are running on.
15062306a36Sopenharmony_ci	 */
15162306a36Sopenharmony_ci	if (mv78xx0_core_index() == 0) {
15262306a36Sopenharmony_ci		phys = MV78XX0_CORE0_REGS_PHYS_BASE;
15362306a36Sopenharmony_ci	} else {
15462306a36Sopenharmony_ci		phys = MV78XX0_CORE1_REGS_PHYS_BASE;
15562306a36Sopenharmony_ci	}
15662306a36Sopenharmony_ci	mv78xx0_io_desc[0].pfn = __phys_to_pfn(phys);
15762306a36Sopenharmony_ci
15862306a36Sopenharmony_ci	iotable_init(mv78xx0_io_desc, ARRAY_SIZE(mv78xx0_io_desc));
15962306a36Sopenharmony_ci}
16062306a36Sopenharmony_ci
16162306a36Sopenharmony_ci
16262306a36Sopenharmony_ci/*****************************************************************************
16362306a36Sopenharmony_ci * CLK tree
16462306a36Sopenharmony_ci ****************************************************************************/
16562306a36Sopenharmony_cistatic struct clk *tclk;
16662306a36Sopenharmony_ci
16762306a36Sopenharmony_cistatic void __init clk_init(void)
16862306a36Sopenharmony_ci{
16962306a36Sopenharmony_ci	tclk = clk_register_fixed_rate(NULL, "tclk", NULL, 0, get_tclk());
17062306a36Sopenharmony_ci
17162306a36Sopenharmony_ci	orion_clkdev_init(tclk);
17262306a36Sopenharmony_ci}
17362306a36Sopenharmony_ci
17462306a36Sopenharmony_ci/*****************************************************************************
17562306a36Sopenharmony_ci * EHCI
17662306a36Sopenharmony_ci ****************************************************************************/
17762306a36Sopenharmony_civoid __init mv78xx0_ehci0_init(void)
17862306a36Sopenharmony_ci{
17962306a36Sopenharmony_ci	orion_ehci_init(USB0_PHYS_BASE, IRQ_MV78XX0_USB_0, EHCI_PHY_NA);
18062306a36Sopenharmony_ci}
18162306a36Sopenharmony_ci
18262306a36Sopenharmony_ci
18362306a36Sopenharmony_ci/*****************************************************************************
18462306a36Sopenharmony_ci * EHCI1
18562306a36Sopenharmony_ci ****************************************************************************/
18662306a36Sopenharmony_civoid __init mv78xx0_ehci1_init(void)
18762306a36Sopenharmony_ci{
18862306a36Sopenharmony_ci	orion_ehci_1_init(USB1_PHYS_BASE, IRQ_MV78XX0_USB_1);
18962306a36Sopenharmony_ci}
19062306a36Sopenharmony_ci
19162306a36Sopenharmony_ci
19262306a36Sopenharmony_ci/*****************************************************************************
19362306a36Sopenharmony_ci * EHCI2
19462306a36Sopenharmony_ci ****************************************************************************/
19562306a36Sopenharmony_civoid __init mv78xx0_ehci2_init(void)
19662306a36Sopenharmony_ci{
19762306a36Sopenharmony_ci	orion_ehci_2_init(USB2_PHYS_BASE, IRQ_MV78XX0_USB_2);
19862306a36Sopenharmony_ci}
19962306a36Sopenharmony_ci
20062306a36Sopenharmony_ci
20162306a36Sopenharmony_ci/*****************************************************************************
20262306a36Sopenharmony_ci * GE00
20362306a36Sopenharmony_ci ****************************************************************************/
20462306a36Sopenharmony_civoid __init mv78xx0_ge00_init(struct mv643xx_eth_platform_data *eth_data)
20562306a36Sopenharmony_ci{
20662306a36Sopenharmony_ci	orion_ge00_init(eth_data,
20762306a36Sopenharmony_ci			GE00_PHYS_BASE, IRQ_MV78XX0_GE00_SUM,
20862306a36Sopenharmony_ci			IRQ_MV78XX0_GE_ERR,
20962306a36Sopenharmony_ci			MV643XX_TX_CSUM_DEFAULT_LIMIT);
21062306a36Sopenharmony_ci}
21162306a36Sopenharmony_ci
21262306a36Sopenharmony_ci
21362306a36Sopenharmony_ci/*****************************************************************************
21462306a36Sopenharmony_ci * GE01
21562306a36Sopenharmony_ci ****************************************************************************/
21662306a36Sopenharmony_civoid __init mv78xx0_ge01_init(struct mv643xx_eth_platform_data *eth_data)
21762306a36Sopenharmony_ci{
21862306a36Sopenharmony_ci	orion_ge01_init(eth_data,
21962306a36Sopenharmony_ci			GE01_PHYS_BASE, IRQ_MV78XX0_GE01_SUM,
22062306a36Sopenharmony_ci			MV643XX_TX_CSUM_DEFAULT_LIMIT);
22162306a36Sopenharmony_ci}
22262306a36Sopenharmony_ci
22362306a36Sopenharmony_ci
22462306a36Sopenharmony_ci/*****************************************************************************
22562306a36Sopenharmony_ci * GE10
22662306a36Sopenharmony_ci ****************************************************************************/
22762306a36Sopenharmony_civoid __init mv78xx0_ge10_init(struct mv643xx_eth_platform_data *eth_data)
22862306a36Sopenharmony_ci{
22962306a36Sopenharmony_ci	u32 dev, rev;
23062306a36Sopenharmony_ci
23162306a36Sopenharmony_ci	/*
23262306a36Sopenharmony_ci	 * On the Z0, ge10 and ge11 are internally connected back
23362306a36Sopenharmony_ci	 * to back, and not brought out.
23462306a36Sopenharmony_ci	 */
23562306a36Sopenharmony_ci	mv78xx0_pcie_id(&dev, &rev);
23662306a36Sopenharmony_ci	if (dev == MV78X00_Z0_DEV_ID) {
23762306a36Sopenharmony_ci		eth_data->phy_addr = MV643XX_ETH_PHY_NONE;
23862306a36Sopenharmony_ci		eth_data->speed = SPEED_1000;
23962306a36Sopenharmony_ci		eth_data->duplex = DUPLEX_FULL;
24062306a36Sopenharmony_ci	}
24162306a36Sopenharmony_ci
24262306a36Sopenharmony_ci	orion_ge10_init(eth_data, GE10_PHYS_BASE, IRQ_MV78XX0_GE10_SUM);
24362306a36Sopenharmony_ci}
24462306a36Sopenharmony_ci
24562306a36Sopenharmony_ci
24662306a36Sopenharmony_ci/*****************************************************************************
24762306a36Sopenharmony_ci * GE11
24862306a36Sopenharmony_ci ****************************************************************************/
24962306a36Sopenharmony_civoid __init mv78xx0_ge11_init(struct mv643xx_eth_platform_data *eth_data)
25062306a36Sopenharmony_ci{
25162306a36Sopenharmony_ci	u32 dev, rev;
25262306a36Sopenharmony_ci
25362306a36Sopenharmony_ci	/*
25462306a36Sopenharmony_ci	 * On the Z0, ge10 and ge11 are internally connected back
25562306a36Sopenharmony_ci	 * to back, and not brought out.
25662306a36Sopenharmony_ci	 */
25762306a36Sopenharmony_ci	mv78xx0_pcie_id(&dev, &rev);
25862306a36Sopenharmony_ci	if (dev == MV78X00_Z0_DEV_ID) {
25962306a36Sopenharmony_ci		eth_data->phy_addr = MV643XX_ETH_PHY_NONE;
26062306a36Sopenharmony_ci		eth_data->speed = SPEED_1000;
26162306a36Sopenharmony_ci		eth_data->duplex = DUPLEX_FULL;
26262306a36Sopenharmony_ci	}
26362306a36Sopenharmony_ci
26462306a36Sopenharmony_ci	orion_ge11_init(eth_data, GE11_PHYS_BASE, IRQ_MV78XX0_GE11_SUM);
26562306a36Sopenharmony_ci}
26662306a36Sopenharmony_ci
26762306a36Sopenharmony_ci/*****************************************************************************
26862306a36Sopenharmony_ci * I2C
26962306a36Sopenharmony_ci ****************************************************************************/
27062306a36Sopenharmony_civoid __init mv78xx0_i2c_init(void)
27162306a36Sopenharmony_ci{
27262306a36Sopenharmony_ci	orion_i2c_init(I2C_0_PHYS_BASE, IRQ_MV78XX0_I2C_0, 8);
27362306a36Sopenharmony_ci	orion_i2c_1_init(I2C_1_PHYS_BASE, IRQ_MV78XX0_I2C_1, 8);
27462306a36Sopenharmony_ci}
27562306a36Sopenharmony_ci
27662306a36Sopenharmony_ci/*****************************************************************************
27762306a36Sopenharmony_ci * SATA
27862306a36Sopenharmony_ci ****************************************************************************/
27962306a36Sopenharmony_civoid __init mv78xx0_sata_init(struct mv_sata_platform_data *sata_data)
28062306a36Sopenharmony_ci{
28162306a36Sopenharmony_ci	orion_sata_init(sata_data, SATA_PHYS_BASE, IRQ_MV78XX0_SATA);
28262306a36Sopenharmony_ci}
28362306a36Sopenharmony_ci
28462306a36Sopenharmony_ci
28562306a36Sopenharmony_ci/*****************************************************************************
28662306a36Sopenharmony_ci * UART0
28762306a36Sopenharmony_ci ****************************************************************************/
28862306a36Sopenharmony_civoid __init mv78xx0_uart0_init(void)
28962306a36Sopenharmony_ci{
29062306a36Sopenharmony_ci	orion_uart0_init(UART0_VIRT_BASE, UART0_PHYS_BASE,
29162306a36Sopenharmony_ci			 IRQ_MV78XX0_UART_0, tclk);
29262306a36Sopenharmony_ci}
29362306a36Sopenharmony_ci
29462306a36Sopenharmony_ci
29562306a36Sopenharmony_ci/*****************************************************************************
29662306a36Sopenharmony_ci * UART1
29762306a36Sopenharmony_ci ****************************************************************************/
29862306a36Sopenharmony_civoid __init mv78xx0_uart1_init(void)
29962306a36Sopenharmony_ci{
30062306a36Sopenharmony_ci	orion_uart1_init(UART1_VIRT_BASE, UART1_PHYS_BASE,
30162306a36Sopenharmony_ci			 IRQ_MV78XX0_UART_1, tclk);
30262306a36Sopenharmony_ci}
30362306a36Sopenharmony_ci
30462306a36Sopenharmony_ci
30562306a36Sopenharmony_ci/*****************************************************************************
30662306a36Sopenharmony_ci * UART2
30762306a36Sopenharmony_ci ****************************************************************************/
30862306a36Sopenharmony_civoid __init mv78xx0_uart2_init(void)
30962306a36Sopenharmony_ci{
31062306a36Sopenharmony_ci	orion_uart2_init(UART2_VIRT_BASE, UART2_PHYS_BASE,
31162306a36Sopenharmony_ci			 IRQ_MV78XX0_UART_2, tclk);
31262306a36Sopenharmony_ci}
31362306a36Sopenharmony_ci
31462306a36Sopenharmony_ci/*****************************************************************************
31562306a36Sopenharmony_ci * UART3
31662306a36Sopenharmony_ci ****************************************************************************/
31762306a36Sopenharmony_civoid __init mv78xx0_uart3_init(void)
31862306a36Sopenharmony_ci{
31962306a36Sopenharmony_ci	orion_uart3_init(UART3_VIRT_BASE, UART3_PHYS_BASE,
32062306a36Sopenharmony_ci			 IRQ_MV78XX0_UART_3, tclk);
32162306a36Sopenharmony_ci}
32262306a36Sopenharmony_ci
32362306a36Sopenharmony_ci/*****************************************************************************
32462306a36Sopenharmony_ci * Time handling
32562306a36Sopenharmony_ci ****************************************************************************/
32662306a36Sopenharmony_civoid __init mv78xx0_init_early(void)
32762306a36Sopenharmony_ci{
32862306a36Sopenharmony_ci	orion_time_set_base(TIMER_VIRT_BASE);
32962306a36Sopenharmony_ci	if (mv78xx0_core_index() == 0)
33062306a36Sopenharmony_ci		mvebu_mbus_init("marvell,mv78xx0-mbus",
33162306a36Sopenharmony_ci				BRIDGE_WINS_CPU0_BASE, BRIDGE_WINS_SZ,
33262306a36Sopenharmony_ci				DDR_WINDOW_CPU0_BASE, DDR_WINDOW_CPU_SZ);
33362306a36Sopenharmony_ci	else
33462306a36Sopenharmony_ci		mvebu_mbus_init("marvell,mv78xx0-mbus",
33562306a36Sopenharmony_ci				BRIDGE_WINS_CPU1_BASE, BRIDGE_WINS_SZ,
33662306a36Sopenharmony_ci				DDR_WINDOW_CPU1_BASE, DDR_WINDOW_CPU_SZ);
33762306a36Sopenharmony_ci}
33862306a36Sopenharmony_ci
33962306a36Sopenharmony_civoid __ref mv78xx0_timer_init(void)
34062306a36Sopenharmony_ci{
34162306a36Sopenharmony_ci	orion_time_init(BRIDGE_VIRT_BASE, BRIDGE_INT_TIMER1_CLR,
34262306a36Sopenharmony_ci			IRQ_MV78XX0_TIMER_1, get_tclk());
34362306a36Sopenharmony_ci}
34462306a36Sopenharmony_ci
34562306a36Sopenharmony_ci/****************************************************************************
34662306a36Sopenharmony_ci* XOR engine
34762306a36Sopenharmony_ci****************************************************************************/
34862306a36Sopenharmony_civoid __init mv78xx0_xor_init(void)
34962306a36Sopenharmony_ci{
35062306a36Sopenharmony_ci	orion_xor0_init(XOR_PHYS_BASE,
35162306a36Sopenharmony_ci		XOR_PHYS_BASE + 0x200,
35262306a36Sopenharmony_ci		IRQ_MV78XX0_XOR_0, IRQ_MV78XX0_XOR_1);
35362306a36Sopenharmony_ci}
35462306a36Sopenharmony_ci
35562306a36Sopenharmony_ci/****************************************************************************
35662306a36Sopenharmony_ci * Cryptographic Engines and Security Accelerator (CESA)
35762306a36Sopenharmony_ci****************************************************************************/
35862306a36Sopenharmony_civoid __init mv78xx0_crypto_init(void)
35962306a36Sopenharmony_ci{
36062306a36Sopenharmony_ci	mvebu_mbus_add_window_by_id(MV78XX0_MBUS_SRAM_TARGET,
36162306a36Sopenharmony_ci				MV78XX0_MBUS_SRAM_ATTR,
36262306a36Sopenharmony_ci				MV78XX0_SRAM_PHYS_BASE,
36362306a36Sopenharmony_ci			MV78XX0_SRAM_SIZE);
36462306a36Sopenharmony_ci	orion_crypto_init(CRYPTO_PHYS_BASE, MV78XX0_SRAM_PHYS_BASE,
36562306a36Sopenharmony_ci		SZ_8K, IRQ_MV78XX0_CRYPTO);
36662306a36Sopenharmony_ci}
36762306a36Sopenharmony_ci
36862306a36Sopenharmony_ci
36962306a36Sopenharmony_ci/*****************************************************************************
37062306a36Sopenharmony_ci * General
37162306a36Sopenharmony_ci ****************************************************************************/
37262306a36Sopenharmony_cistatic char * __init mv78xx0_id(void)
37362306a36Sopenharmony_ci{
37462306a36Sopenharmony_ci	u32 dev, rev;
37562306a36Sopenharmony_ci
37662306a36Sopenharmony_ci	mv78xx0_pcie_id(&dev, &rev);
37762306a36Sopenharmony_ci
37862306a36Sopenharmony_ci	if (dev == MV78X00_Z0_DEV_ID) {
37962306a36Sopenharmony_ci		if (rev == MV78X00_REV_Z0)
38062306a36Sopenharmony_ci			return "MV78X00-Z0";
38162306a36Sopenharmony_ci		else
38262306a36Sopenharmony_ci			return "MV78X00-Rev-Unsupported";
38362306a36Sopenharmony_ci	} else if (dev == MV78100_DEV_ID) {
38462306a36Sopenharmony_ci		if (rev == MV78100_REV_A0)
38562306a36Sopenharmony_ci			return "MV78100-A0";
38662306a36Sopenharmony_ci		else if (rev == MV78100_REV_A1)
38762306a36Sopenharmony_ci			return "MV78100-A1";
38862306a36Sopenharmony_ci		else
38962306a36Sopenharmony_ci			return "MV78100-Rev-Unsupported";
39062306a36Sopenharmony_ci	} else if (dev == MV78200_DEV_ID) {
39162306a36Sopenharmony_ci		if (rev == MV78100_REV_A0)
39262306a36Sopenharmony_ci			return "MV78200-A0";
39362306a36Sopenharmony_ci		else
39462306a36Sopenharmony_ci			return "MV78200-Rev-Unsupported";
39562306a36Sopenharmony_ci	} else {
39662306a36Sopenharmony_ci		return "Device-Unknown";
39762306a36Sopenharmony_ci	}
39862306a36Sopenharmony_ci}
39962306a36Sopenharmony_ci
40062306a36Sopenharmony_cistatic int __init is_l2_writethrough(void)
40162306a36Sopenharmony_ci{
40262306a36Sopenharmony_ci	return !!(readl(CPU_CONTROL) & L2_WRITETHROUGH);
40362306a36Sopenharmony_ci}
40462306a36Sopenharmony_ci
40562306a36Sopenharmony_civoid __init mv78xx0_init(void)
40662306a36Sopenharmony_ci{
40762306a36Sopenharmony_ci	int core_index;
40862306a36Sopenharmony_ci	int hclk;
40962306a36Sopenharmony_ci	int pclk;
41062306a36Sopenharmony_ci	int l2clk;
41162306a36Sopenharmony_ci
41262306a36Sopenharmony_ci	core_index = mv78xx0_core_index();
41362306a36Sopenharmony_ci	hclk = get_hclk();
41462306a36Sopenharmony_ci	get_pclk_l2clk(hclk, core_index, &pclk, &l2clk);
41562306a36Sopenharmony_ci
41662306a36Sopenharmony_ci	printk(KERN_INFO "%s ", mv78xx0_id());
41762306a36Sopenharmony_ci	printk("core #%d, ", core_index);
41862306a36Sopenharmony_ci	printk("PCLK = %dMHz, ", (pclk + 499999) / 1000000);
41962306a36Sopenharmony_ci	printk("L2 = %dMHz, ", (l2clk + 499999) / 1000000);
42062306a36Sopenharmony_ci	printk("HCLK = %dMHz, ", (hclk + 499999) / 1000000);
42162306a36Sopenharmony_ci	printk("TCLK = %dMHz\n", (get_tclk() + 499999) / 1000000);
42262306a36Sopenharmony_ci
42362306a36Sopenharmony_ci	if (IS_ENABLED(CONFIG_CACHE_FEROCEON_L2))
42462306a36Sopenharmony_ci		feroceon_l2_init(is_l2_writethrough());
42562306a36Sopenharmony_ci
42662306a36Sopenharmony_ci	/* Setup root of clk tree */
42762306a36Sopenharmony_ci	clk_init();
42862306a36Sopenharmony_ci}
42962306a36Sopenharmony_ci
43062306a36Sopenharmony_civoid mv78xx0_restart(enum reboot_mode mode, const char *cmd)
43162306a36Sopenharmony_ci{
43262306a36Sopenharmony_ci	/*
43362306a36Sopenharmony_ci	 * Enable soft reset to assert RSTOUTn.
43462306a36Sopenharmony_ci	 */
43562306a36Sopenharmony_ci	writel(SOFT_RESET_OUT_EN, RSTOUTn_MASK);
43662306a36Sopenharmony_ci
43762306a36Sopenharmony_ci	/*
43862306a36Sopenharmony_ci	 * Assert soft reset.
43962306a36Sopenharmony_ci	 */
44062306a36Sopenharmony_ci	writel(SOFT_RESET, SYSTEM_SOFT_RESET);
44162306a36Sopenharmony_ci
44262306a36Sopenharmony_ci	while (1)
44362306a36Sopenharmony_ci		;
44462306a36Sopenharmony_ci}
445