1a47a12beSStefan Roese/* 2a47a12beSStefan Roese * Copyright 2008-2010 Freescale Semiconductor, Inc. 3a47a12beSStefan Roese * Kumar Gala <kumar.gala@freescale.com> 4a47a12beSStefan Roese * 5a47a12beSStefan Roese * See file CREDITS for list of people who contributed to this 6a47a12beSStefan Roese * project. 7a47a12beSStefan Roese * 8a47a12beSStefan Roese * This program is free software; you can redistribute it and/or 9a47a12beSStefan Roese * modify it under the terms of the GNU General Public License as 10a47a12beSStefan Roese * published by the Free Software Foundation; either version 2 of 11a47a12beSStefan Roese * the License, or (at your option) any later version. 12a47a12beSStefan Roese * 13a47a12beSStefan Roese * This program is distributed in the hope that it will be useful, 14a47a12beSStefan Roese * but WITHOUT ANY WARRANTY; without even the implied warranty of 15a47a12beSStefan Roese * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 16a47a12beSStefan Roese * GNU General Public License for more details. 17a47a12beSStefan Roese * 18a47a12beSStefan Roese * You should have received a copy of the GNU General Public License 19a47a12beSStefan Roese * along with this program; if not, write to the Free Software 20a47a12beSStefan Roese * Foundation, Inc., 59 Temple Place, Suite 330, Boston, 21a47a12beSStefan Roese * MA 02111-1307 USA 22a47a12beSStefan Roese */ 23a47a12beSStefan Roese 24a47a12beSStefan Roese#include <config.h> 25a47a12beSStefan Roese#include <mpc85xx.h> 26a47a12beSStefan Roese#include <version.h> 27a47a12beSStefan Roese 28a47a12beSStefan Roese#define _LINUX_CONFIG_H 1 /* avoid reading Linux autoconf.h file */ 29a47a12beSStefan Roese 30a47a12beSStefan Roese#include <ppc_asm.tmpl> 31a47a12beSStefan Roese#include <ppc_defs.h> 32a47a12beSStefan Roese 33a47a12beSStefan Roese#include <asm/cache.h> 34a47a12beSStefan Roese#include <asm/mmu.h> 35a47a12beSStefan Roese 36a47a12beSStefan Roese/* To boot secondary cpus, we need a place for them to start up. 37a47a12beSStefan Roese * Normally, they start at 0xfffffffc, but that's usually the 38a47a12beSStefan Roese * firmware, and we don't want to have to run the firmware again. 39a47a12beSStefan Roese * Instead, the primary cpu will set the BPTR to point here to 40a47a12beSStefan Roese * this page. We then set up the core, and head to 41a47a12beSStefan Roese * start_secondary. Note that this means that the code below 42a47a12beSStefan Roese * must never exceed 1023 instructions (the branch at the end 43a47a12beSStefan Roese * would then be the 1024th). 44a47a12beSStefan Roese */ 45a47a12beSStefan Roese .globl __secondary_start_page 46a47a12beSStefan Roese .align 12 47a47a12beSStefan Roese__secondary_start_page: 48a47a12beSStefan Roese/* First do some preliminary setup */ 49a47a12beSStefan Roese lis r3, HID0_EMCP@h /* enable machine check */ 50a47a12beSStefan Roese#ifndef CONFIG_E500MC 51a47a12beSStefan Roese ori r3,r3,HID0_TBEN@l /* enable Timebase */ 52a47a12beSStefan Roese#endif 53a47a12beSStefan Roese#ifdef CONFIG_PHYS_64BIT 54a47a12beSStefan Roese ori r3,r3,HID0_ENMAS7@l /* enable MAS7 updates */ 55a47a12beSStefan Roese#endif 56a47a12beSStefan Roese mtspr SPRN_HID0,r3 57a47a12beSStefan Roese 58a47a12beSStefan Roese#ifndef CONFIG_E500MC 59a47a12beSStefan Roese li r3,(HID1_ASTME|HID1_ABE)@l /* Addr streaming & broadcast */ 60a47a12beSStefan Roese mfspr r0,PVR 61a47a12beSStefan Roese andi. r0,r0,0xff 62a47a12beSStefan Roese cmpwi r0,0x50@l /* if we are rev 5.0 or greater set MBDD */ 63a47a12beSStefan Roese blt 1f 64a47a12beSStefan Roese /* Set MBDD bit also */ 65a47a12beSStefan Roese ori r3, r3, HID1_MBDD@l 66a47a12beSStefan Roese1: 67a47a12beSStefan Roese mtspr SPRN_HID1,r3 68a47a12beSStefan Roese#endif 69a47a12beSStefan Roese 70a47a12beSStefan Roese /* Enable branch prediction */ 71a47a12beSStefan Roese lis r3,BUCSR_ENABLE@h 72a47a12beSStefan Roese ori r3,r3,BUCSR_ENABLE@l 73a47a12beSStefan Roese mtspr SPRN_BUCSR,r3 74a47a12beSStefan Roese 75a47a12beSStefan Roese /* Ensure TB is 0 */ 76a47a12beSStefan Roese li r3,0 77a47a12beSStefan Roese mttbl r3 78a47a12beSStefan Roese mttbu r3 79a47a12beSStefan Roese 80a47a12beSStefan Roese /* Enable/invalidate the I-Cache */ 81a47a12beSStefan Roese lis r2,(L1CSR1_ICFI|L1CSR1_ICLFR)@h 82a47a12beSStefan Roese ori r2,r2,(L1CSR1_ICFI|L1CSR1_ICLFR)@l 83a47a12beSStefan Roese mtspr SPRN_L1CSR1,r2 84a47a12beSStefan Roese1: 85a47a12beSStefan Roese mfspr r3,SPRN_L1CSR1 86a47a12beSStefan Roese and. r1,r3,r2 87a47a12beSStefan Roese bne 1b 88a47a12beSStefan Roese 89a47a12beSStefan Roese lis r3,(L1CSR1_CPE|L1CSR1_ICE)@h 90a47a12beSStefan Roese ori r3,r3,(L1CSR1_CPE|L1CSR1_ICE)@l 91a47a12beSStefan Roese mtspr SPRN_L1CSR1,r3 92a47a12beSStefan Roese isync 93a47a12beSStefan Roese2: 94a47a12beSStefan Roese mfspr r3,SPRN_L1CSR1 95a47a12beSStefan Roese andi. r1,r3,L1CSR1_ICE@l 96a47a12beSStefan Roese beq 2b 97a47a12beSStefan Roese 98a47a12beSStefan Roese /* Enable/invalidate the D-Cache */ 99a47a12beSStefan Roese lis r2,(L1CSR0_DCFI|L1CSR0_DCLFR)@h 100a47a12beSStefan Roese ori r2,r2,(L1CSR0_DCFI|L1CSR0_DCLFR)@l 101a47a12beSStefan Roese mtspr SPRN_L1CSR0,r2 102a47a12beSStefan Roese1: 103a47a12beSStefan Roese mfspr r3,SPRN_L1CSR0 104a47a12beSStefan Roese and. r1,r3,r2 105a47a12beSStefan Roese bne 1b 106a47a12beSStefan Roese 107a47a12beSStefan Roese lis r3,(L1CSR0_CPE|L1CSR0_DCE)@h 108a47a12beSStefan Roese ori r3,r3,(L1CSR0_CPE|L1CSR0_DCE)@l 109a47a12beSStefan Roese mtspr SPRN_L1CSR0,r3 110a47a12beSStefan Roese isync 111a47a12beSStefan Roese2: 112a47a12beSStefan Roese mfspr r3,SPRN_L1CSR0 113a47a12beSStefan Roese andi. r1,r3,L1CSR0_DCE@l 114a47a12beSStefan Roese beq 2b 115a47a12beSStefan Roese 116a47a12beSStefan Roese#define toreset(x) (x - __secondary_start_page + 0xfffff000) 117a47a12beSStefan Roese 118a47a12beSStefan Roese /* get our PIR to figure out our table entry */ 119a47a12beSStefan Roese lis r3,toreset(__spin_table)@h 120a47a12beSStefan Roese ori r3,r3,toreset(__spin_table)@l 121a47a12beSStefan Roese 122a47a12beSStefan Roese /* r10 has the base address for the entry */ 123a47a12beSStefan Roese mfspr r0,SPRN_PIR 124a47a12beSStefan Roese#ifdef CONFIG_E500MC 125a47a12beSStefan Roese rlwinm r4,r0,27,27,31 126a47a12beSStefan Roese#else 127a47a12beSStefan Roese mr r4,r0 128a47a12beSStefan Roese#endif 129a47a12beSStefan Roese slwi r8,r4,5 130a47a12beSStefan Roese add r10,r3,r8 131a47a12beSStefan Roese 132a47a12beSStefan Roese#if defined(CONFIG_E500MC) && defined(CONFIG_SYS_CACHE_STASHING) 133a47a12beSStefan Roese /* set stash id to (coreID) * 2 + 32 + L1 CT (0) */ 134a47a12beSStefan Roese slwi r8,r4,1 135a47a12beSStefan Roese addi r8,r8,32 136a47a12beSStefan Roese mtspr L1CSR2,r8 137a47a12beSStefan Roese#endif 138a47a12beSStefan Roese 139*fd3c9befSKumar Gala#if defined(CONFIG_SYS_P4080_ERRATUM_CPU22) 140*fd3c9befSKumar Gala mfspr r8,L1CSR2 141*fd3c9befSKumar Gala oris r8,r8,(L1CSR2_DCWS)@h 142*fd3c9befSKumar Gala mtspr L1CSR2,r8 143*fd3c9befSKumar Gala#endif 144*fd3c9befSKumar Gala 145a47a12beSStefan Roese#ifdef CONFIG_BACKSIDE_L2_CACHE 146a47a12beSStefan Roese /* Enable/invalidate the L2 cache */ 147a47a12beSStefan Roese msync 148a47a12beSStefan Roese lis r2,(L2CSR0_L2FI|L2CSR0_L2LFC)@h 149a47a12beSStefan Roese ori r2,r2,(L2CSR0_L2FI|L2CSR0_L2LFC)@l 150a47a12beSStefan Roese mtspr SPRN_L2CSR0,r2 151a47a12beSStefan Roese1: 152a47a12beSStefan Roese mfspr r3,SPRN_L2CSR0 153a47a12beSStefan Roese and. r1,r3,r2 154a47a12beSStefan Roese bne 1b 155a47a12beSStefan Roese 156a47a12beSStefan Roese#ifdef CONFIG_SYS_CACHE_STASHING 157a47a12beSStefan Roese /* set stash id to (coreID) * 2 + 32 + L2 (1) */ 158a47a12beSStefan Roese addi r3,r8,1 159a47a12beSStefan Roese mtspr SPRN_L2CSR1,r3 160a47a12beSStefan Roese#endif 161a47a12beSStefan Roese 162a47a12beSStefan Roese lis r3,CONFIG_SYS_INIT_L2CSR0@h 163a47a12beSStefan Roese ori r3,r3,CONFIG_SYS_INIT_L2CSR0@l 164a47a12beSStefan Roese mtspr SPRN_L2CSR0,r3 165a47a12beSStefan Roese isync 166a47a12beSStefan Roese2: 167a47a12beSStefan Roese mfspr r3,SPRN_L2CSR0 168a47a12beSStefan Roese andis. r1,r3,L2CSR0_L2E@h 169a47a12beSStefan Roese beq 2b 170a47a12beSStefan Roese#endif 171a47a12beSStefan Roese 172a47a12beSStefan Roese#define EPAPR_MAGIC (0x45504150) 173a47a12beSStefan Roese#define ENTRY_ADDR_UPPER 0 174a47a12beSStefan Roese#define ENTRY_ADDR_LOWER 4 175a47a12beSStefan Roese#define ENTRY_R3_UPPER 8 176a47a12beSStefan Roese#define ENTRY_R3_LOWER 12 177a47a12beSStefan Roese#define ENTRY_RESV 16 178a47a12beSStefan Roese#define ENTRY_PIR 20 179a47a12beSStefan Roese#define ENTRY_R6_UPPER 24 180a47a12beSStefan Roese#define ENTRY_R6_LOWER 28 181a47a12beSStefan Roese#define ENTRY_SIZE 32 182a47a12beSStefan Roese 183a47a12beSStefan Roese /* setup the entry */ 184a47a12beSStefan Roese li r3,0 185a47a12beSStefan Roese li r8,1 186a47a12beSStefan Roese stw r0,ENTRY_PIR(r10) 187a47a12beSStefan Roese stw r3,ENTRY_ADDR_UPPER(r10) 188a47a12beSStefan Roese stw r8,ENTRY_ADDR_LOWER(r10) 189a47a12beSStefan Roese stw r3,ENTRY_R3_UPPER(r10) 190a47a12beSStefan Roese stw r4,ENTRY_R3_LOWER(r10) 191a47a12beSStefan Roese stw r3,ENTRY_R6_UPPER(r10) 192a47a12beSStefan Roese stw r3,ENTRY_R6_LOWER(r10) 193a47a12beSStefan Roese 194a47a12beSStefan Roese /* load r13 with the address of the 'bootpg' in SDRAM */ 195a47a12beSStefan Roese lis r13,toreset(__bootpg_addr)@h 196a47a12beSStefan Roese ori r13,r13,toreset(__bootpg_addr)@l 197a47a12beSStefan Roese lwz r13,0(r13) 198a47a12beSStefan Roese 199a47a12beSStefan Roese /* setup mapping for AS = 1, and jump there */ 200a47a12beSStefan Roese lis r11,(MAS0_TLBSEL(1)|MAS0_ESEL(1))@h 201a47a12beSStefan Roese mtspr SPRN_MAS0,r11 202a47a12beSStefan Roese lis r11,(MAS1_VALID|MAS1_IPROT)@h 203a47a12beSStefan Roese ori r11,r11,(MAS1_TS|MAS1_TSIZE(BOOKE_PAGESZ_4K))@l 204a47a12beSStefan Roese mtspr SPRN_MAS1,r11 205a47a12beSStefan Roese oris r11,r13,(MAS2_I|MAS2_G)@h 206a47a12beSStefan Roese ori r11,r13,(MAS2_I|MAS2_G)@l 207a47a12beSStefan Roese mtspr SPRN_MAS2,r11 208a47a12beSStefan Roese oris r11,r13,(MAS3_SX|MAS3_SW|MAS3_SR)@h 209a47a12beSStefan Roese ori r11,r13,(MAS3_SX|MAS3_SW|MAS3_SR)@l 210a47a12beSStefan Roese mtspr SPRN_MAS3,r11 211a47a12beSStefan Roese tlbwe 212a47a12beSStefan Roese 213a47a12beSStefan Roese bl 1f 214a47a12beSStefan Roese1: mflr r11 215a47a12beSStefan Roese /* 216a47a12beSStefan Roese * OR in 0xfff to create a mask of the bootpg SDRAM address. We use 217a47a12beSStefan Roese * this mask to fixup the cpu spin table and the address that we want 218a47a12beSStefan Roese * to jump to, eg change them from 0xfffffxxx to 0x7ffffxxx if the 219a47a12beSStefan Roese * bootpg is at 0x7ffff000 in SDRAM. 220a47a12beSStefan Roese */ 221a47a12beSStefan Roese ori r13,r13,0xfff 222a47a12beSStefan Roese and r11, r11, r13 223a47a12beSStefan Roese and r10, r10, r13 224a47a12beSStefan Roese 225a47a12beSStefan Roese addi r11,r11,(2f-1b) 226a47a12beSStefan Roese mfmsr r13 227a47a12beSStefan Roese ori r12,r13,MSR_IS|MSR_DS@l 228a47a12beSStefan Roese 229a47a12beSStefan Roese mtspr SPRN_SRR0,r11 230a47a12beSStefan Roese mtspr SPRN_SRR1,r12 231a47a12beSStefan Roese rfi 232a47a12beSStefan Roese 233a47a12beSStefan Roese /* spin waiting for addr */ 234a47a12beSStefan Roese2: 235a47a12beSStefan Roese lwz r4,ENTRY_ADDR_LOWER(r10) 236a47a12beSStefan Roese andi. r11,r4,1 237a47a12beSStefan Roese bne 2b 238a47a12beSStefan Roese isync 239a47a12beSStefan Roese 240a47a12beSStefan Roese /* setup IVORs to match fixed offsets */ 241a47a12beSStefan Roese#include "fixed_ivor.S" 242a47a12beSStefan Roese 243a47a12beSStefan Roese /* get the upper bits of the addr */ 244a47a12beSStefan Roese lwz r11,ENTRY_ADDR_UPPER(r10) 245a47a12beSStefan Roese 246a47a12beSStefan Roese /* setup branch addr */ 247a47a12beSStefan Roese mtspr SPRN_SRR0,r4 248a47a12beSStefan Roese 249a47a12beSStefan Roese /* mark the entry as released */ 250a47a12beSStefan Roese li r8,3 251a47a12beSStefan Roese stw r8,ENTRY_ADDR_LOWER(r10) 252a47a12beSStefan Roese 253a47a12beSStefan Roese /* mask by ~64M to setup our tlb we will jump to */ 254a47a12beSStefan Roese rlwinm r12,r4,0,0,5 255a47a12beSStefan Roese 256a47a12beSStefan Roese /* setup r3, r4, r5, r6, r7, r8, r9 */ 257a47a12beSStefan Roese lwz r3,ENTRY_R3_LOWER(r10) 258a47a12beSStefan Roese li r4,0 259a47a12beSStefan Roese li r5,0 260a47a12beSStefan Roese lwz r6,ENTRY_R6_LOWER(r10) 261a47a12beSStefan Roese lis r7,(64*1024*1024)@h 262a47a12beSStefan Roese li r8,0 263a47a12beSStefan Roese li r9,0 264a47a12beSStefan Roese 265a47a12beSStefan Roese /* load up the pir */ 266a47a12beSStefan Roese lwz r0,ENTRY_PIR(r10) 267a47a12beSStefan Roese mtspr SPRN_PIR,r0 268a47a12beSStefan Roese mfspr r0,SPRN_PIR 269a47a12beSStefan Roese stw r0,ENTRY_PIR(r10) 270a47a12beSStefan Roese 271a47a12beSStefan Roese mtspr IVPR,r12 272a47a12beSStefan Roese/* 273a47a12beSStefan Roese * Coming here, we know the cpu has one TLB mapping in TLB1[0] 274a47a12beSStefan Roese * which maps 0xfffff000-0xffffffff one-to-one. We set up a 275a47a12beSStefan Roese * second mapping that maps addr 1:1 for 64M, and then we jump to 276a47a12beSStefan Roese * addr 277a47a12beSStefan Roese */ 278a47a12beSStefan Roese lis r10,(MAS0_TLBSEL(1)|MAS0_ESEL(0))@h 279a47a12beSStefan Roese mtspr SPRN_MAS0,r10 280a47a12beSStefan Roese lis r10,(MAS1_VALID|MAS1_IPROT)@h 281a47a12beSStefan Roese ori r10,r10,(MAS1_TSIZE(BOOKE_PAGESZ_64M))@l 282a47a12beSStefan Roese mtspr SPRN_MAS1,r10 283a47a12beSStefan Roese /* WIMGE = 0b00000 for now */ 284a47a12beSStefan Roese mtspr SPRN_MAS2,r12 285a47a12beSStefan Roese ori r12,r12,(MAS3_SX|MAS3_SW|MAS3_SR) 286a47a12beSStefan Roese mtspr SPRN_MAS3,r12 287a47a12beSStefan Roese#ifdef CONFIG_ENABLE_36BIT_PHYS 288a47a12beSStefan Roese mtspr SPRN_MAS7,r11 289a47a12beSStefan Roese#endif 290a47a12beSStefan Roese tlbwe 291a47a12beSStefan Roese 292a47a12beSStefan Roese/* Now we have another mapping for this page, so we jump to that 293a47a12beSStefan Roese * mapping 294a47a12beSStefan Roese */ 295a47a12beSStefan Roese mtspr SPRN_SRR1,r13 296a47a12beSStefan Roese rfi 297a47a12beSStefan Roese 298a47a12beSStefan Roese /* 299a47a12beSStefan Roese * Allocate some space for the SDRAM address of the bootpg. 300a47a12beSStefan Roese * This variable has to be in the boot page so that it can 301a47a12beSStefan Roese * be accessed by secondary cores when they come out of reset. 302a47a12beSStefan Roese */ 303a47a12beSStefan Roese .globl __bootpg_addr 304a47a12beSStefan Roese__bootpg_addr: 305a47a12beSStefan Roese .long 0 306a47a12beSStefan Roese 307a47a12beSStefan Roese .align L1_CACHE_SHIFT 308a47a12beSStefan Roese .globl __spin_table 309a47a12beSStefan Roese__spin_table: 310a47a12beSStefan Roese .space CONFIG_MAX_CPUS*ENTRY_SIZE 311a47a12beSStefan Roese 312a47a12beSStefan Roese /* Fill in the empty space. The actual reset vector is 313a47a12beSStefan Roese * the last word of the page */ 314a47a12beSStefan Roese__secondary_start_code_end: 315a47a12beSStefan Roese .space 4092 - (__secondary_start_code_end - __secondary_start_page) 316a47a12beSStefan Roese__secondary_reset_vector: 317a47a12beSStefan Roese b __secondary_start_page 318