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