minix/u-boot
1
0
Fork 0
mirror of https://github.com/Stichting-MINIX-Research-Foundation/u-boot.git synced 2025-09-09 20:18:54 -04:00
Code Issues Packages Projects Releases Wiki Activity

85xx: Update multicore boot mechanism to ePAPR v0.81 spec

Browse Source 
The following changes are needed to be inline with ePAPR v0.81:

* r4, r5 and now always set to 0 on boot release
* r7 is used to pass the size of the initial map area (IMA)
* EPAPR_MAGIC value changed for book-e processors
* changes in the spin table layout
* spin table supports a 64-bit physical release address

Signed-off-by: Kumar Gala <galak@kernel.crashing.org>
This commit is contained in:
Kumar Gala 2008-03-26 08:34:25 -05:00 committed by Andrew Fleming-AFLEMING
parent 25eedb2c19
commit 79679d8002
6 changed files with 121 additions and 73 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

15
common/cmd_mp.c
View File

@ -26,7 +26,7 @@
int int
cpu_cmd(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[]) cpu_cmd(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
{ {
unsigned long cpuid, val = 0; unsigned long cpuid;
if (argc < 3) { if (argc < 3) {
printf ("Usage:\n%s\n", cmdtp->usage); printf ("Usage:\n%s\n", cmdtp->usage);
@ -59,9 +59,7 @@ cpu_cmd(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
return 1; return 1;
} }
val = simple_strtoul(argv[3], NULL, 16); if (cpu_release(cpuid, argc - 3, argv + 3)) {
if (cpu_release(cpuid, val, argc - 4, argv + 4)) {
printf ("Usage:\n%s\n", cmdtp->usage); printf ("Usage:\n%s\n", cmdtp->usage);
return 1; return 1;
} }
@ -71,17 +69,16 @@ cpu_cmd(cmd_tbl_t *cmdtp, int flag, int argc, char *argv[])
#ifdef CONFIG_PPC #ifdef CONFIG_PPC
#define CPU_ARCH_HELP \ #define CPU_ARCH_HELP \
" [args] : <pir> <r3> <r4> <r6> <r7>\n" \ " [args] : <pir> <r3> <r6>\n" \
" pir - processor id (if writeable)\n" \ " pir - processor id (if writeable)\n" \
" r3 - value for gpr 3\n" \ " r3 - value for gpr 3\n" \
" r4 - value for gpr 4\n" \
" r6 - value for gpr 6\n" \ " r6 - value for gpr 6\n" \
" r7 - value for gpr 7\n" \
"\n" \ "\n" \
" Use '-' for any arg if you want the default value.\n" \ " Use '-' for any arg if you want the default value.\n" \
" Default for r3, r4, r7 is 0, r6 is 0x65504150\n" \ " Default for r3 is <num> and r6 is 0\n" \
"\n" \ "\n" \
" When cpu <num> is released r5 = 0 per the ePAPR spec.\n" " When cpu <num> is released r4 and r5 = 0.\n" \
" r7 will contain the size of the initial mapped area\n"
#endif #endif
U_BOOT_CMD( U_BOOT_CMD(

2
cpu/mpc85xx/fdt.c
View File

@ -52,7 +52,7 @@ void ft_fixup_cpu(void *blob, u64 memory_limit)
if (*reg == id) { if (*reg == id) {
fdt_setprop_string(blob, off, "status", "okay"); fdt_setprop_string(blob, off, "status", "okay");
} else { } else {
u32 val = *reg * 24 + spin_tbl_addr; u32 val = *reg * SIZE_BOOT_ENTRY + spin_tbl_addr;
val = cpu_to_fdt32(val); val = cpu_to_fdt32(val);
fdt_setprop_string(blob, off, "status", fdt_setprop_string(blob, off, "status",
"disabled"); "disabled");

44
cpu/mpc85xx/mp.c
View File

@ -28,14 +28,6 @@
DECLARE_GLOBAL_DATA_PTR; DECLARE_GLOBAL_DATA_PTR;
#define BOOT_ENTRY_ADDR 0
#define BOOT_ENTRY_PIR 1
#define BOOT_ENTRY_R3 2
#define BOOT_ENTRY_R4 3
#define BOOT_ENTRY_R6 4
#define BOOT_ENTRY_R7 5
#define NUM_BOOT_ENTRY 6
u32 get_my_id() u32 get_my_id()
{ {
return mfspr(SPRN_PIR); return mfspr(SPRN_PIR);
@ -63,40 +55,54 @@ int cpu_status(int nr)
printf("Running on cpu %d\n", id); printf("Running on cpu %d\n", id);
printf("\n"); printf("\n");
printf("table @ 0x%08x:\n", table); printf("table @ 0x%08x:\n", table);
printf(" addr - 0x%08x\n", table[BOOT_ENTRY_ADDR]); printf(" addr - 0x%08x\n", table[BOOT_ENTRY_ADDR_LOWER]);
printf(" pir - 0x%08x\n", table[BOOT_ENTRY_PIR]); printf(" pir - 0x%08x\n", table[BOOT_ENTRY_PIR]);
printf(" r3 - 0x%08x\n", table[BOOT_ENTRY_R3]); printf(" r3 - 0x%08x\n", table[BOOT_ENTRY_R3_LOWER]);
printf(" r4 - 0x%08x\n", table[BOOT_ENTRY_R4]); printf(" r6 - 0x%08x\n", table[BOOT_ENTRY_R6_LOWER]);
printf(" r6 - 0x%08x\n", table[BOOT_ENTRY_R6]);
printf(" r7 - 0x%08x\n", table[BOOT_ENTRY_R7]);
} }
return 0; return 0;
} }
int cpu_release(int nr, unsigned long boot_addr, int argc, char *argv[]) static u8 boot_entry_map[4] = {
0,
BOOT_ENTRY_PIR,
BOOT_ENTRY_R3_LOWER,
BOOT_ENTRY_R6_LOWER,
};
int cpu_release(int nr, int argc, char *argv[])
{ {
u32 i, val, *table = (u32 *)get_spin_addr() + nr * NUM_BOOT_ENTRY; u32 i, val, *table = (u32 *)get_spin_addr() + nr * NUM_BOOT_ENTRY;
u64 boot_addr;
if (nr == get_my_id()) { if (nr == get_my_id()) {
printf("Invalid to release the boot core.\n\n"); printf("Invalid to release the boot core.\n\n");
return 1; return 1;
} }
if (argc != 5) { if (argc != 4) {
printf("Invalid number of arguments to release.\n\n"); printf("Invalid number of arguments to release.\n\n");
return 1; return 1;
} }
/* handle pir, r3, r4, r6, r7 */ #ifdef CFG_64BIT_STRTOUL
for (i = 0; i < 5; i++) { boot_addr = simple_strtoull(argv[0], NULL, 16);
#else
boot_addr = simple_strtoul(argv[0], NULL, 16);
#endif
/* handle pir, r3, r6 */
for (i = 1; i < 4; i++) {
if (argv[i][0] != '-') { if (argv[i][0] != '-') {
u8 entry = boot_entry_map[i];
val = simple_strtoul(argv[i], NULL, 16); val = simple_strtoul(argv[i], NULL, 16);
table[i+BOOT_ENTRY_PIR] = val; table[entry] = val;
} }
} }
table[BOOT_ENTRY_ADDR] = boot_addr; table[BOOT_ENTRY_ADDR_UPPER] = (u32)(boot_addr >> 32);
table[BOOT_ENTRY_ADDR_LOWER] = (u32)(boot_addr & 0xffffffff);
return 0; return 0;
} }

11
cpu/mpc85xx/mp.h
View File

@ -5,4 +5,15 @@ ulong get_spin_addr(void);
void setup_mp(void); void setup_mp(void);
u32 get_my_id(void); u32 get_my_id(void);
#define BOOT_ENTRY_ADDR_UPPER 0
#define BOOT_ENTRY_ADDR_LOWER 1
#define BOOT_ENTRY_R3_UPPER 2
#define BOOT_ENTRY_R3_LOWER 3
#define BOOT_ENTRY_RESV 4
#define BOOT_ENTRY_PIR 5
#define BOOT_ENTRY_R6_UPPER 6
#define BOOT_ENTRY_R6_LOWER 7
#define NUM_BOOT_ENTRY 8
#define SIZE_BOOT_ENTRY (NUM_BOOT_ENTRY * sizeof(u32))
#endif #endif

120
cpu/mpc85xx/release.S
View File

@ -57,61 +57,91 @@ __secondary_start_page:
lis r3,toreset(__spin_table)@h lis r3,toreset(__spin_table)@h
ori r3,r3,toreset(__spin_table)@l ori r3,r3,toreset(__spin_table)@l
/* r9 has the base address for the entry */ /* r10 has the base address for the entry */
mfspr r0,SPRN_PIR mfspr r0,SPRN_PIR
mr r4,r0 mr r4,r0
slwi r8,r4,4 slwi r8,r4,5
slwi r9,r4,3 add r10,r3,r8
add r8,r8,r9
add r9,r3,r8
#define EPAPR_MAGIC (0x65504150) #define EPAPR_MAGIC (0x45504150)
#define ENTRY_ADDR 0 #define ENTRY_ADDR_UPPER 0
#define ENTRY_PIR 4 #define ENTRY_ADDR_LOWER 4
#define ENTRY_R3 8 #define ENTRY_R3_UPPER 8
#define ENTRY_R4 12 #define ENTRY_R3_LOWER 12
#define ENTRY_R6 16 #define ENTRY_RESV 16
#define ENTRY_R7 20 #define ENTRY_PIR 20
#define ENTRY_R6_UPPER 24
#define ENTRY_R6_LOWER 28
#define ENTRY_SIZE 32
/* setup the entry */ /* setup the entry */
li r4,0 li r3,0
li r8,1 li r8,1
lis r6,EPAPR_MAGIC@h stw r0,ENTRY_PIR(r10)
ori r6,r6,EPAPR_MAGIC@l stw r3,ENTRY_ADDR_UPPER(r10)
stw r0,ENTRY_PIR(r9) stw r8,ENTRY_ADDR_LOWER(r10)
stw r8,ENTRY_ADDR(r9) stw r3,ENTRY_R3_UPPER(r10)
stw r4,ENTRY_R3(r9) stw r4,ENTRY_R3_LOWER(r10)
stw r4,ENTRY_R4(r9) stw r3,ENTRY_R6_UPPER(r10)
stw r6,ENTRY_R6(r9) stw r3,ENTRY_R6_LOWER(r10)
stw r4,ENTRY_R7(r9)
/* setup mapping for AS = 1, and jump there */
lis r11,(MAS0_TLBSEL(1)|MAS0_ESEL(1))@h
mtspr SPRN_MAS0,r11
lis r11,(MAS1_VALID|MAS1_IPROT)@h
ori r11,r11,(MAS1_TS|MAS1_TSIZE(BOOKE_PAGESZ_4K))@l
mtspr SPRN_MAS1,r11
lis r11,(0xfffff000|MAS2_I)@h
ori r11,r11,(0xfffff000|MAS2_I)@l
mtspr SPRN_MAS2,r11
lis r11,(0xfffff000|MAS3_SX|MAS3_SW|MAS3_SR)@h
ori r11,r11,(0xfffff000|MAS3_SX|MAS3_SW|MAS3_SR)@l
mtspr SPRN_MAS3,r11
tlbwe
bl 1f
1: mflr r11
addi r11,r11,28
mfmsr r13
ori r12,r13,MSR_IS|MSR_DS@l
mtspr SPRN_SRR0,r11
mtspr SPRN_SRR1,r12
rfi
/* spin waiting for addr */ /* spin waiting for addr */
1: lwz r4,ENTRY_ADDR(r9) 2:
lwz r4,ENTRY_ADDR_LOWER(r10)
andi. r11,r4,1 andi. r11,r4,1
bne 1b bne 2b
/* get the upper bits of the addr */
lwz r11,ENTRY_ADDR_UPPER(r10)
/* setup branch addr */ /* setup branch addr */
mtctr r4 mtspr SPRN_SRR0,r4
/* mark the entry as released */ /* mark the entry as released */
li r8,3 li r8,3
stw r8,ENTRY_ADDR(r9) stw r8,ENTRY_ADDR_LOWER(r10)
/* mask by ~64M to setup our tlb we will jump to */ /* mask by ~64M to setup our tlb we will jump to */
rlwinm r8,r4,0,0,5 rlwinm r12,r4,0,0,5
/* setup r3, r5, r6, r7 */ /* setup r3, r4, r5, r6, r7, r8, r9 */
lwz r3,ENTRY_R3(r9) lwz r3,ENTRY_R3_LOWER(r10)
lwz r4,ENTRY_R4(r9) li r4,0
li r5,0 li r5,0
lwz r6,ENTRY_R6(r9) lwz r6,ENTRY_R6_LOWER(r10)
lwz r7,ENTRY_R7(r9) lis r7,(64*1024*1024)@h
li r8,0
li r9,0
/* load up the pir */ /* load up the pir */
lwz r0,ENTRY_PIR(r9) lwz r0,ENTRY_PIR(r10)
mtspr SPRN_PIR,r0 mtspr SPRN_PIR,r0
mfspr r0,SPRN_PIR mfspr r0,SPRN_PIR
stw r0,ENTRY_PIR(r9) stw r0,ENTRY_PIR(r10)
/* /*
* Coming here, we know the cpu has one TLB mapping in TLB1[0] * Coming here, we know the cpu has one TLB mapping in TLB1[0]
@ -119,26 +149,30 @@ __secondary_start_page:
* second mapping that maps addr 1:1 for 64M, and then we jump to * second mapping that maps addr 1:1 for 64M, and then we jump to
* addr * addr
*/ */
lis r9,(MAS0_TLBSEL(1)|MAS0_ESEL(1))@h lis r10,(MAS0_TLBSEL(1)|MAS0_ESEL(0))@h
mtspr SPRN_MAS0,r9 mtspr SPRN_MAS0,r10
lis r9,(MAS1_VALID|MAS1_IPROT)@h lis r10,(MAS1_VALID|MAS1_IPROT)@h
ori r9,r9,(MAS1_TSIZE(BOOKE_PAGESZ_64M))@l ori r10,r10,(MAS1_TSIZE(BOOKE_PAGESZ_64M))@l
mtspr SPRN_MAS1,r9 mtspr SPRN_MAS1,r10
/* WIMGE = 0b00000 for now */ /* WIMGE = 0b00000 for now */
mtspr SPRN_MAS2,r8 mtspr SPRN_MAS2,r12
ori r8,r8,(MAS3_SX|MAS3_SW|MAS3_SR) ori r12,r12,(MAS3_SX|MAS3_SW|MAS3_SR)
mtspr SPRN_MAS3,r8 mtspr SPRN_MAS3,r12
#ifdef CONFIG_ENABLE_36BIT_PHYS
mtspr SPRN_MAS7,r11
#endif
tlbwe tlbwe
/* Now we have another mapping for this page, so we jump to that /* Now we have another mapping for this page, so we jump to that
* mapping * mapping
*/ */
bctr mtspr SPRN_SRR1,r13
rfi
.align 3 .align 3
.globl __spin_table .globl __spin_table
__spin_table: __spin_table:
.space CONFIG_NR_CPUS*24 .space CONFIG_NR_CPUS*ENTRY_SIZE
/* Fill in the empty space. The actual reset vector is /* Fill in the empty space. The actual reset vector is
* the last word of the page */ * the last word of the page */

2
include/common.h
View File

@ -673,7 +673,7 @@ void inline show_boot_progress (int val);
#ifdef CONFIG_MP #ifdef CONFIG_MP
int cpu_status(int nr); int cpu_status(int nr);
int cpu_reset(int nr); int cpu_reset(int nr);
int cpu_release(int nr, unsigned long boot_addr, int argc, char *argv[]); int cpu_release(int nr, int argc, char *argv[]);
#endif #endif
#endif /* __COMMON_H_ */ #endif /* __COMMON_H_ */