|
@@ -1,5 +1,5 @@
|
|
|
/*
|
|
|
- * Copyright 2014 Freescale Semiconductor, Inc.
|
|
|
+ * Copyright 2014-2015 Freescale Semiconductor, Inc.
|
|
|
*
|
|
|
* SPDX-License-Identifier: GPL-2.0+
|
|
|
*/
|
|
@@ -10,34 +10,28 @@
|
|
|
#include <asm/system.h>
|
|
|
#include <asm/armv8/mmu.h>
|
|
|
#include <asm/io.h>
|
|
|
-#include <asm/arch-fsl-lsch3/soc.h>
|
|
|
-#include <asm/arch-fsl-lsch3/immap_lsch3.h>
|
|
|
+#include <asm/arch/fsl_serdes.h>
|
|
|
+#include <asm/arch/soc.h>
|
|
|
+#include <asm/arch/cpu.h>
|
|
|
+#include <asm/arch/speed.h>
|
|
|
+#ifdef CONFIG_MP
|
|
|
+#include <asm/arch/mp.h>
|
|
|
+#endif
|
|
|
+#include <fm_eth.h>
|
|
|
#include <fsl_debug_server.h>
|
|
|
#include <fsl-mc/fsl_mc.h>
|
|
|
-#include <asm/arch/fsl_serdes.h>
|
|
|
#ifdef CONFIG_FSL_ESDHC
|
|
|
#include <fsl_esdhc.h>
|
|
|
#endif
|
|
|
-#include "cpu.h"
|
|
|
-#include "mp.h"
|
|
|
-#include "speed.h"
|
|
|
|
|
|
DECLARE_GLOBAL_DATA_PTR;
|
|
|
|
|
|
-static struct cpu_type cpu_type_list[] = {
|
|
|
-#ifdef CONFIG_LS2085A
|
|
|
- CPU_TYPE_ENTRY(LS2085, LS2085, 8),
|
|
|
- CPU_TYPE_ENTRY(LS2080, LS2080, 8),
|
|
|
- CPU_TYPE_ENTRY(LS2045, LS2045, 4),
|
|
|
-#endif
|
|
|
-};
|
|
|
-
|
|
|
void cpu_name(char *name)
|
|
|
{
|
|
|
struct ccsr_gur __iomem *gur = (void *)(CONFIG_SYS_FSL_GUTS_ADDR);
|
|
|
unsigned int i, svr, ver;
|
|
|
|
|
|
- svr = in_le32(&gur->svr);
|
|
|
+ svr = gur_in32(&gur->svr);
|
|
|
ver = SVR_SOC_VER(svr);
|
|
|
|
|
|
for (i = 0; i < ARRAY_SIZE(cpu_type_list); i++)
|
|
@@ -54,146 +48,6 @@ void cpu_name(char *name)
|
|
|
}
|
|
|
|
|
|
#ifndef CONFIG_SYS_DCACHE_OFF
|
|
|
-
|
|
|
-#define SECTION_SHIFT_L0 39UL
|
|
|
-#define SECTION_SHIFT_L1 30UL
|
|
|
-#define SECTION_SHIFT_L2 21UL
|
|
|
-#define BLOCK_SIZE_L0 0x8000000000
|
|
|
-#define BLOCK_SIZE_L1 0x40000000
|
|
|
-#define BLOCK_SIZE_L2 0x200000
|
|
|
-
|
|
|
-#define NUM_OF_ENTRY 512
|
|
|
-
|
|
|
-#define TCR_EL2_PS_40BIT (2 << 16)
|
|
|
-#define LSCH3_VA_BITS (40)
|
|
|
-#define LSCH3_TCR (TCR_TG0_4K | \
|
|
|
- TCR_EL2_PS_40BIT | \
|
|
|
- TCR_SHARED_NON | \
|
|
|
- TCR_ORGN_NC | \
|
|
|
- TCR_IRGN_NC | \
|
|
|
- TCR_T0SZ(LSCH3_VA_BITS))
|
|
|
-#define LSCH3_TCR_FINAL (TCR_TG0_4K | \
|
|
|
- TCR_EL2_PS_40BIT | \
|
|
|
- TCR_SHARED_OUTER | \
|
|
|
- TCR_ORGN_WBWA | \
|
|
|
- TCR_IRGN_WBWA | \
|
|
|
- TCR_T0SZ(LSCH3_VA_BITS))
|
|
|
-
|
|
|
-#define CONFIG_SYS_FSL_CCSR_BASE 0x00000000
|
|
|
-#define CONFIG_SYS_FSL_CCSR_SIZE 0x10000000
|
|
|
-#define CONFIG_SYS_FSL_QSPI_BASE1 0x20000000
|
|
|
-#define CONFIG_SYS_FSL_QSPI_SIZE1 0x10000000
|
|
|
-#define CONFIG_SYS_FSL_IFC_BASE1 0x30000000
|
|
|
-#define CONFIG_SYS_FSL_IFC_SIZE1 0x10000000
|
|
|
-#define CONFIG_SYS_FSL_IFC_SIZE1_1 0x400000
|
|
|
-#define CONFIG_SYS_FSL_DRAM_BASE1 0x80000000
|
|
|
-#define CONFIG_SYS_FSL_DRAM_SIZE1 0x80000000
|
|
|
-#define CONFIG_SYS_FSL_QSPI_BASE2 0x400000000
|
|
|
-#define CONFIG_SYS_FSL_QSPI_SIZE2 0x100000000
|
|
|
-#define CONFIG_SYS_FSL_IFC_BASE2 0x500000000
|
|
|
-#define CONFIG_SYS_FSL_IFC_SIZE2 0x100000000
|
|
|
-#define CONFIG_SYS_FSL_DCSR_BASE 0x700000000
|
|
|
-#define CONFIG_SYS_FSL_DCSR_SIZE 0x40000000
|
|
|
-#define CONFIG_SYS_FSL_MC_BASE 0x80c000000
|
|
|
-#define CONFIG_SYS_FSL_MC_SIZE 0x4000000
|
|
|
-#define CONFIG_SYS_FSL_NI_BASE 0x810000000
|
|
|
-#define CONFIG_SYS_FSL_NI_SIZE 0x8000000
|
|
|
-#define CONFIG_SYS_FSL_QBMAN_BASE 0x818000000
|
|
|
-#define CONFIG_SYS_FSL_QBMAN_SIZE 0x8000000
|
|
|
-#define CONFIG_SYS_FSL_QBMAN_SIZE_1 0x4000000
|
|
|
-#define CONFIG_SYS_PCIE1_PHYS_SIZE 0x200000000
|
|
|
-#define CONFIG_SYS_PCIE2_PHYS_SIZE 0x200000000
|
|
|
-#define CONFIG_SYS_PCIE3_PHYS_SIZE 0x200000000
|
|
|
-#define CONFIG_SYS_PCIE4_PHYS_SIZE 0x200000000
|
|
|
-#define CONFIG_SYS_FSL_WRIOP1_BASE 0x4300000000
|
|
|
-#define CONFIG_SYS_FSL_WRIOP1_SIZE 0x100000000
|
|
|
-#define CONFIG_SYS_FSL_AIOP1_BASE 0x4b00000000
|
|
|
-#define CONFIG_SYS_FSL_AIOP1_SIZE 0x100000000
|
|
|
-#define CONFIG_SYS_FSL_PEBUF_BASE 0x4c00000000
|
|
|
-#define CONFIG_SYS_FSL_PEBUF_SIZE 0x400000000
|
|
|
-#define CONFIG_SYS_FSL_DRAM_BASE2 0x8080000000
|
|
|
-#define CONFIG_SYS_FSL_DRAM_SIZE2 0x7F80000000
|
|
|
-
|
|
|
-struct sys_mmu_table {
|
|
|
- u64 virt_addr;
|
|
|
- u64 phys_addr;
|
|
|
- u64 size;
|
|
|
- u64 memory_type;
|
|
|
- u64 share;
|
|
|
-};
|
|
|
-
|
|
|
-static const struct sys_mmu_table lsch3_early_mmu_table[] = {
|
|
|
- { CONFIG_SYS_FSL_CCSR_BASE, CONFIG_SYS_FSL_CCSR_BASE,
|
|
|
- CONFIG_SYS_FSL_CCSR_SIZE, MT_DEVICE_NGNRNE, PMD_SECT_NON_SHARE },
|
|
|
- { CONFIG_SYS_FSL_OCRAM_BASE, CONFIG_SYS_FSL_OCRAM_BASE,
|
|
|
- CONFIG_SYS_FSL_OCRAM_SIZE, MT_NORMAL, PMD_SECT_NON_SHARE },
|
|
|
- /* For IFC Region #1, only the first 4MB is cache-enabled */
|
|
|
- { CONFIG_SYS_FSL_IFC_BASE1, CONFIG_SYS_FSL_IFC_BASE1,
|
|
|
- CONFIG_SYS_FSL_IFC_SIZE1_1, MT_NORMAL, PMD_SECT_NON_SHARE },
|
|
|
- { CONFIG_SYS_FSL_IFC_BASE1 + CONFIG_SYS_FSL_IFC_SIZE1_1,
|
|
|
- CONFIG_SYS_FSL_IFC_BASE1 + CONFIG_SYS_FSL_IFC_SIZE1_1,
|
|
|
- CONFIG_SYS_FSL_IFC_SIZE1 - CONFIG_SYS_FSL_IFC_SIZE1_1,
|
|
|
- MT_DEVICE_NGNRNE, PMD_SECT_NON_SHARE },
|
|
|
- { CONFIG_SYS_FLASH_BASE, CONFIG_SYS_FSL_IFC_BASE1,
|
|
|
- CONFIG_SYS_FSL_IFC_SIZE1, MT_DEVICE_NGNRNE, PMD_SECT_NON_SHARE },
|
|
|
- { CONFIG_SYS_FSL_DRAM_BASE1, CONFIG_SYS_FSL_DRAM_BASE1,
|
|
|
- CONFIG_SYS_FSL_DRAM_SIZE1, MT_NORMAL, PMD_SECT_OUTER_SHARE },
|
|
|
- { CONFIG_SYS_FSL_DCSR_BASE, CONFIG_SYS_FSL_DCSR_BASE,
|
|
|
- CONFIG_SYS_FSL_DCSR_SIZE, MT_DEVICE_NGNRNE, PMD_SECT_NON_SHARE },
|
|
|
- { CONFIG_SYS_FSL_DRAM_BASE2, CONFIG_SYS_FSL_DRAM_BASE2,
|
|
|
- CONFIG_SYS_FSL_DRAM_SIZE2, MT_NORMAL, PMD_SECT_OUTER_SHARE },
|
|
|
-};
|
|
|
-
|
|
|
-static const struct sys_mmu_table lsch3_final_mmu_table[] = {
|
|
|
- { CONFIG_SYS_FSL_CCSR_BASE, CONFIG_SYS_FSL_CCSR_BASE,
|
|
|
- CONFIG_SYS_FSL_CCSR_SIZE, MT_DEVICE_NGNRNE, PMD_SECT_NON_SHARE },
|
|
|
- { CONFIG_SYS_FSL_OCRAM_BASE, CONFIG_SYS_FSL_OCRAM_BASE,
|
|
|
- CONFIG_SYS_FSL_OCRAM_SIZE, MT_NORMAL, PMD_SECT_NON_SHARE },
|
|
|
- { CONFIG_SYS_FSL_DRAM_BASE1, CONFIG_SYS_FSL_DRAM_BASE1,
|
|
|
- CONFIG_SYS_FSL_DRAM_SIZE1, MT_NORMAL, PMD_SECT_OUTER_SHARE },
|
|
|
- { CONFIG_SYS_FSL_QSPI_BASE2, CONFIG_SYS_FSL_QSPI_BASE2,
|
|
|
- CONFIG_SYS_FSL_QSPI_SIZE2, MT_DEVICE_NGNRNE, PMD_SECT_NON_SHARE },
|
|
|
- { CONFIG_SYS_FSL_IFC_BASE2, CONFIG_SYS_FSL_IFC_BASE2,
|
|
|
- CONFIG_SYS_FSL_IFC_SIZE2, MT_DEVICE_NGNRNE, PMD_SECT_NON_SHARE },
|
|
|
- { CONFIG_SYS_FSL_DCSR_BASE, CONFIG_SYS_FSL_DCSR_BASE,
|
|
|
- CONFIG_SYS_FSL_DCSR_SIZE, MT_DEVICE_NGNRNE, PMD_SECT_NON_SHARE },
|
|
|
- { CONFIG_SYS_FSL_MC_BASE, CONFIG_SYS_FSL_MC_BASE,
|
|
|
- CONFIG_SYS_FSL_MC_SIZE, MT_DEVICE_NGNRNE, PMD_SECT_NON_SHARE },
|
|
|
- { CONFIG_SYS_FSL_NI_BASE, CONFIG_SYS_FSL_NI_BASE,
|
|
|
- CONFIG_SYS_FSL_NI_SIZE, MT_DEVICE_NGNRNE, PMD_SECT_NON_SHARE },
|
|
|
- /* For QBMAN portal, only the first 64MB is cache-enabled */
|
|
|
- { CONFIG_SYS_FSL_QBMAN_BASE, CONFIG_SYS_FSL_QBMAN_BASE,
|
|
|
- CONFIG_SYS_FSL_QBMAN_SIZE_1, MT_NORMAL, PMD_SECT_NON_SHARE },
|
|
|
- { CONFIG_SYS_FSL_QBMAN_BASE + CONFIG_SYS_FSL_QBMAN_SIZE_1,
|
|
|
- CONFIG_SYS_FSL_QBMAN_BASE + CONFIG_SYS_FSL_QBMAN_SIZE_1,
|
|
|
- CONFIG_SYS_FSL_QBMAN_SIZE - CONFIG_SYS_FSL_QBMAN_SIZE_1,
|
|
|
- MT_DEVICE_NGNRNE, PMD_SECT_NON_SHARE },
|
|
|
- { CONFIG_SYS_PCIE1_PHYS_ADDR, CONFIG_SYS_PCIE1_PHYS_ADDR,
|
|
|
- CONFIG_SYS_PCIE1_PHYS_SIZE, MT_DEVICE_NGNRNE, PMD_SECT_NON_SHARE },
|
|
|
- { CONFIG_SYS_PCIE2_PHYS_ADDR, CONFIG_SYS_PCIE2_PHYS_ADDR,
|
|
|
- CONFIG_SYS_PCIE2_PHYS_SIZE, MT_DEVICE_NGNRNE, PMD_SECT_NON_SHARE },
|
|
|
- { CONFIG_SYS_PCIE3_PHYS_ADDR, CONFIG_SYS_PCIE3_PHYS_ADDR,
|
|
|
- CONFIG_SYS_PCIE3_PHYS_SIZE, MT_DEVICE_NGNRNE, PMD_SECT_NON_SHARE },
|
|
|
-#ifdef CONFIG_LS2085A
|
|
|
- { CONFIG_SYS_PCIE4_PHYS_ADDR, CONFIG_SYS_PCIE4_PHYS_ADDR,
|
|
|
- CONFIG_SYS_PCIE4_PHYS_SIZE, MT_DEVICE_NGNRNE, PMD_SECT_NON_SHARE },
|
|
|
-#endif
|
|
|
- { CONFIG_SYS_FSL_WRIOP1_BASE, CONFIG_SYS_FSL_WRIOP1_BASE,
|
|
|
- CONFIG_SYS_FSL_WRIOP1_SIZE, MT_DEVICE_NGNRNE, PMD_SECT_NON_SHARE },
|
|
|
- { CONFIG_SYS_FSL_AIOP1_BASE, CONFIG_SYS_FSL_AIOP1_BASE,
|
|
|
- CONFIG_SYS_FSL_AIOP1_SIZE, MT_DEVICE_NGNRNE, PMD_SECT_NON_SHARE },
|
|
|
- { CONFIG_SYS_FSL_PEBUF_BASE, CONFIG_SYS_FSL_PEBUF_BASE,
|
|
|
- CONFIG_SYS_FSL_PEBUF_SIZE, MT_DEVICE_NGNRNE, PMD_SECT_NON_SHARE },
|
|
|
- { CONFIG_SYS_FSL_DRAM_BASE2, CONFIG_SYS_FSL_DRAM_BASE2,
|
|
|
- CONFIG_SYS_FSL_DRAM_SIZE2, MT_NORMAL, PMD_SECT_OUTER_SHARE },
|
|
|
-};
|
|
|
-
|
|
|
-struct table_info {
|
|
|
- u64 *ptr;
|
|
|
- u64 table_base;
|
|
|
- u64 entry_size;
|
|
|
-};
|
|
|
-
|
|
|
/*
|
|
|
* Set the block entries according to the information of the table.
|
|
|
*/
|
|
@@ -311,6 +165,7 @@ static inline void early_mmu_setup(void)
|
|
|
u64 *level1_table1 = (u64 *)(CONFIG_SYS_FSL_OCRAM_BASE + 0x2000);
|
|
|
u64 *level2_table0 = (u64 *)(CONFIG_SYS_FSL_OCRAM_BASE + 0x3000);
|
|
|
u64 *level2_table1 = (u64 *)(CONFIG_SYS_FSL_OCRAM_BASE + 0x4000);
|
|
|
+
|
|
|
struct table_info table = {level0_table, 0, BLOCK_SIZE_L0};
|
|
|
|
|
|
/* Invalidate all table entries */
|
|
@@ -320,19 +175,21 @@ static inline void early_mmu_setup(void)
|
|
|
set_pgtable_table(level0_table, 0, level1_table0);
|
|
|
set_pgtable_table(level0_table, 1, level1_table1);
|
|
|
set_pgtable_table(level1_table0, 0, level2_table0);
|
|
|
+
|
|
|
+#ifdef CONFIG_FSL_LSCH3
|
|
|
set_pgtable_table(level1_table0,
|
|
|
CONFIG_SYS_FLASH_BASE >> SECTION_SHIFT_L1,
|
|
|
level2_table1);
|
|
|
-
|
|
|
+#endif
|
|
|
/* Find the table and fill in the block entries */
|
|
|
- for (i = 0; i < ARRAY_SIZE(lsch3_early_mmu_table); i++) {
|
|
|
- if (find_table(&lsch3_early_mmu_table[i],
|
|
|
+ for (i = 0; i < ARRAY_SIZE(early_mmu_table); i++) {
|
|
|
+ if (find_table(&early_mmu_table[i],
|
|
|
&table, level0_table) == 0) {
|
|
|
/*
|
|
|
* If find_table() returns error, it cannot be dealt
|
|
|
* with here. Breakpoint can be added for debugging.
|
|
|
*/
|
|
|
- set_block_entry(&lsch3_early_mmu_table[i], &table);
|
|
|
+ set_block_entry(&early_mmu_table[i], &table);
|
|
|
/*
|
|
|
* If set_block_entry() returns error, it cannot be
|
|
|
* dealt with here too.
|
|
@@ -341,7 +198,9 @@ static inline void early_mmu_setup(void)
|
|
|
}
|
|
|
|
|
|
el = current_el();
|
|
|
- set_ttbr_tcr_mair(el, (u64)level0_table, LSCH3_TCR, MEMORY_ATTRIBUTES);
|
|
|
+
|
|
|
+ set_ttbr_tcr_mair(el, (u64)level0_table, LAYERSCAPE_TCR,
|
|
|
+ MEMORY_ATTRIBUTES);
|
|
|
set_sctlr(get_sctlr() | CR_M);
|
|
|
}
|
|
|
|
|
@@ -353,6 +212,8 @@ static inline void early_mmu_setup(void)
|
|
|
* Level 1 table 0 contains 512 entries for each 1GB from 0 to 512GB.
|
|
|
* Level 1 table 1 contains 512 entries for each 1GB from 512GB to 1TB.
|
|
|
* Level 2 table 0 contains 512 entries for each 2MB from 0 to 1GB.
|
|
|
+ *
|
|
|
+ * For LSCH3:
|
|
|
* Level 2 table 1 contains 512 entries for each 2MB from 32GB to 33GB.
|
|
|
*/
|
|
|
static inline void final_mmu_setup(void)
|
|
@@ -362,7 +223,9 @@ static inline void final_mmu_setup(void)
|
|
|
u64 *level1_table0 = (u64 *)(gd->arch.tlb_addr + 0x1000);
|
|
|
u64 *level1_table1 = (u64 *)(gd->arch.tlb_addr + 0x2000);
|
|
|
u64 *level2_table0 = (u64 *)(gd->arch.tlb_addr + 0x3000);
|
|
|
+#ifdef CONFIG_FSL_LSCH3
|
|
|
u64 *level2_table1 = (u64 *)(gd->arch.tlb_addr + 0x4000);
|
|
|
+#endif
|
|
|
struct table_info table = {level0_table, 0, BLOCK_SIZE_L0};
|
|
|
|
|
|
/* Invalidate all table entries */
|
|
@@ -372,23 +235,25 @@ static inline void final_mmu_setup(void)
|
|
|
set_pgtable_table(level0_table, 0, level1_table0);
|
|
|
set_pgtable_table(level0_table, 1, level1_table1);
|
|
|
set_pgtable_table(level1_table0, 0, level2_table0);
|
|
|
+#ifdef CONFIG_FSL_LSCH3
|
|
|
set_pgtable_table(level1_table0,
|
|
|
CONFIG_SYS_FSL_QBMAN_BASE >> SECTION_SHIFT_L1,
|
|
|
level2_table1);
|
|
|
+#endif
|
|
|
|
|
|
/* Find the table and fill in the block entries */
|
|
|
- for (i = 0; i < ARRAY_SIZE(lsch3_final_mmu_table); i++) {
|
|
|
- if (find_table(&lsch3_final_mmu_table[i],
|
|
|
+ for (i = 0; i < ARRAY_SIZE(final_mmu_table); i++) {
|
|
|
+ if (find_table(&final_mmu_table[i],
|
|
|
&table, level0_table) == 0) {
|
|
|
- if (set_block_entry(&lsch3_final_mmu_table[i],
|
|
|
+ if (set_block_entry(&final_mmu_table[i],
|
|
|
&table) != 0) {
|
|
|
printf("MMU error: could not set block entry for %p\n",
|
|
|
- &lsch3_final_mmu_table[i]);
|
|
|
+ &final_mmu_table[i]);
|
|
|
}
|
|
|
|
|
|
} else {
|
|
|
printf("MMU error: could not find the table for %p\n",
|
|
|
- &lsch3_final_mmu_table[i]);
|
|
|
+ &final_mmu_table[i]);
|
|
|
}
|
|
|
}
|
|
|
|
|
@@ -398,7 +263,8 @@ static inline void final_mmu_setup(void)
|
|
|
|
|
|
/* point TTBR to the new table */
|
|
|
el = current_el();
|
|
|
- set_ttbr_tcr_mair(el, (u64)level0_table, LSCH3_TCR_FINAL,
|
|
|
+
|
|
|
+ set_ttbr_tcr_mair(el, (u64)level0_table, LAYERSCAPE_TCR_FINAL,
|
|
|
MEMORY_ATTRIBUTES);
|
|
|
/*
|
|
|
* MMU is already enabled, just need to invalidate TLB to load the
|
|
@@ -434,8 +300,9 @@ static inline u32 initiator_type(u32 cluster, int init_id)
|
|
|
{
|
|
|
struct ccsr_gur *gur = (void *)(CONFIG_SYS_FSL_GUTS_ADDR);
|
|
|
u32 idx = (cluster >> (init_id * 8)) & TP_CLUSTER_INIT_MASK;
|
|
|
- u32 type = in_le32(&gur->tp_ityp[idx]);
|
|
|
+ u32 type = 0;
|
|
|
|
|
|
+ type = gur_in32(&gur->tp_ityp[idx]);
|
|
|
if (type & TP_ITYP_AV)
|
|
|
return type;
|
|
|
|
|
@@ -450,7 +317,8 @@ u32 cpu_mask(void)
|
|
|
|
|
|
do {
|
|
|
int j;
|
|
|
- cluster = in_le32(&gur->tp_cluster[i].lower);
|
|
|
+
|
|
|
+ cluster = gur_in32(&gur->tp_cluster[i].lower);
|
|
|
for (j = 0; j < TP_INIT_PER_CLUSTER; j++) {
|
|
|
type = initiator_type(cluster, j);
|
|
|
if (type) {
|
|
@@ -460,7 +328,7 @@ u32 cpu_mask(void)
|
|
|
}
|
|
|
}
|
|
|
i++;
|
|
|
- } while ((cluster & TP_CLUSTER_EOC) != TP_CLUSTER_EOC);
|
|
|
+ } while ((cluster & TP_CLUSTER_EOC) == 0x0);
|
|
|
|
|
|
return mask;
|
|
|
}
|
|
@@ -482,7 +350,8 @@ int fsl_qoriq_core_to_cluster(unsigned int core)
|
|
|
|
|
|
do {
|
|
|
int j;
|
|
|
- cluster = in_le32(&gur->tp_cluster[i].lower);
|
|
|
+
|
|
|
+ cluster = gur_in32(&gur->tp_cluster[i].lower);
|
|
|
for (j = 0; j < TP_INIT_PER_CLUSTER; j++) {
|
|
|
if (initiator_type(cluster, j)) {
|
|
|
if (count == core)
|
|
@@ -491,7 +360,7 @@ int fsl_qoriq_core_to_cluster(unsigned int core)
|
|
|
}
|
|
|
}
|
|
|
i++;
|
|
|
- } while ((cluster & TP_CLUSTER_EOC) != TP_CLUSTER_EOC);
|
|
|
+ } while ((cluster & TP_CLUSTER_EOC) == 0x0);
|
|
|
|
|
|
return -1; /* cannot identify the cluster */
|
|
|
}
|
|
@@ -505,7 +374,8 @@ u32 fsl_qoriq_core_to_type(unsigned int core)
|
|
|
|
|
|
do {
|
|
|
int j;
|
|
|
- cluster = in_le32(&gur->tp_cluster[i].lower);
|
|
|
+
|
|
|
+ cluster = gur_in32(&gur->tp_cluster[i].lower);
|
|
|
for (j = 0; j < TP_INIT_PER_CLUSTER; j++) {
|
|
|
type = initiator_type(cluster, j);
|
|
|
if (type) {
|
|
@@ -515,7 +385,7 @@ u32 fsl_qoriq_core_to_type(unsigned int core)
|
|
|
}
|
|
|
}
|
|
|
i++;
|
|
|
- } while ((cluster & TP_CLUSTER_EOC) != TP_CLUSTER_EOC);
|
|
|
+ } while ((cluster & TP_CLUSTER_EOC) == 0x0);
|
|
|
|
|
|
return -1; /* cannot identify the cluster */
|
|
|
}
|
|
@@ -527,15 +397,13 @@ int print_cpuinfo(void)
|
|
|
struct sys_info sysinfo;
|
|
|
char buf[32];
|
|
|
unsigned int i, core;
|
|
|
- u32 type;
|
|
|
+ u32 type, rcw;
|
|
|
|
|
|
puts("SoC: ");
|
|
|
|
|
|
cpu_name(buf);
|
|
|
- printf(" %s (0x%x)\n", buf, in_le32(&gur->svr));
|
|
|
-
|
|
|
+ printf(" %s (0x%x)\n", buf, gur_in32(&gur->svr));
|
|
|
memset((u8 *)buf, 0x00, ARRAY_SIZE(buf));
|
|
|
-
|
|
|
get_sys_info(&sysinfo);
|
|
|
puts("Clock Configuration:");
|
|
|
for_each_cpu(i, core, cpu_numcores(), cpu_mask()) {
|
|
@@ -551,18 +419,20 @@ int print_cpuinfo(void)
|
|
|
printf("\n Bus: %-4s MHz ",
|
|
|
strmhz(buf, sysinfo.freq_systembus));
|
|
|
printf("DDR: %-4s MT/s", strmhz(buf, sysinfo.freq_ddrbus));
|
|
|
+#ifdef CONFIG_FSL_LSCH3
|
|
|
printf(" DP-DDR: %-4s MT/s", strmhz(buf, sysinfo.freq_ddrbus2));
|
|
|
+#endif
|
|
|
puts("\n");
|
|
|
|
|
|
- /* Display the RCW, so that no one gets confused as to what RCW
|
|
|
+ /*
|
|
|
+ * Display the RCW, so that no one gets confused as to what RCW
|
|
|
* we're actually using for this boot.
|
|
|
*/
|
|
|
puts("Reset Configuration Word (RCW):");
|
|
|
for (i = 0; i < ARRAY_SIZE(gur->rcwsr); i++) {
|
|
|
- u32 rcw = in_le32(&gur->rcwsr[i]);
|
|
|
-
|
|
|
+ rcw = gur_in32(&gur->rcwsr[i]);
|
|
|
if ((i % 4) == 0)
|
|
|
- printf("\n %02x:", i * 4);
|
|
|
+ printf("\n %08x:", i * 4);
|
|
|
printf(" %08x", rcw);
|
|
|
}
|
|
|
puts("\n");
|
|
@@ -590,11 +460,13 @@ int cpu_eth_init(bd_t *bis)
|
|
|
|
|
|
int arch_early_init_r(void)
|
|
|
{
|
|
|
- int rv;
|
|
|
- rv = fsl_lsch3_wake_seconday_cores();
|
|
|
+#ifdef CONFIG_MP
|
|
|
+ int rv = 1;
|
|
|
|
|
|
+ rv = fsl_layerscape_wake_seconday_cores();
|
|
|
if (rv)
|
|
|
printf("Did not wake secondary cores\n");
|
|
|
+#endif
|
|
|
|
|
|
#ifdef CONFIG_SYS_HAS_SERDES
|
|
|
fsl_serdes_init();
|
|
@@ -605,7 +477,9 @@ int arch_early_init_r(void)
|
|
|
int timer_init(void)
|
|
|
{
|
|
|
u32 __iomem *cntcr = (u32 *)CONFIG_SYS_FSL_TIMER_ADDR;
|
|
|
+#ifdef CONFIG_FSL_LSCH3
|
|
|
u32 __iomem *cltbenr = (u32 *)CONFIG_SYS_FSL_PMU_CLTBENR;
|
|
|
+#endif
|
|
|
#ifdef COUNTER_FREQUENCY_REAL
|
|
|
unsigned long cntfrq = COUNTER_FREQUENCY_REAL;
|
|
|
|
|
@@ -613,10 +487,12 @@ int timer_init(void)
|
|
|
asm volatile("msr cntfrq_el0, %0" : : "r" (cntfrq) : "memory");
|
|
|
#endif
|
|
|
|
|
|
+#ifdef CONFIG_FSL_LSCH3
|
|
|
/* Enable timebase for all clusters.
|
|
|
* It is safe to do so even some clusters are not enabled.
|
|
|
*/
|
|
|
out_le32(cltbenr, 0xf);
|
|
|
+#endif
|
|
|
|
|
|
/* Enable clock for timer
|
|
|
* This is a global setting.
|
|
@@ -632,7 +508,7 @@ void reset_cpu(ulong addr)
|
|
|
u32 val;
|
|
|
|
|
|
/* Raise RESET_REQ_B */
|
|
|
- val = in_le32(rstcr);
|
|
|
+ val = scfg_in32(rstcr);
|
|
|
val |= 0x02;
|
|
|
- out_le32(rstcr, val);
|
|
|
+ scfg_out32(rstcr, val);
|
|
|
}
|