1 /* 2 * This file is subject to the terms and conditions of the GNU General Public 3 * License. See the file "COPYING" in the main directory of this archive 4 * for more details. 5 * 6 * Copyright (C) 2004-2017 Cavium, Inc. 7 */ 8 9 10 /* 11 We install this program at the bootvector: 12 ------------------------------------ 13 .set noreorder 14 .set nomacro 15 .set noat 16 reset_vector: 17 dmtc0 $k0, $31, 0 # Save $k0 to DESAVE 18 dmtc0 $k1, $31, 3 # Save $k1 to KScratch2 19 20 mfc0 $k0, $12, 0 # Status 21 mfc0 $k1, $15, 1 # Ebase 22 23 ori $k0, 0x84 # Enable 64-bit addressing, set 24 # ERL (should already be set) 25 andi $k1, 0x3ff # mask out core ID 26 27 mtc0 $k0, $12, 0 # Status 28 sll $k1, 5 29 30 lui $k0, 0xbfc0 31 cache 17, 0($0) # Core-14345, clear L1 Dcache virtual 32 # tags if the core hit an NMI 33 34 ld $k0, 0x78($k0) # k0 <- (bfc00078) pointer to the reset vector 35 synci 0($0) # Invalidate ICache to get coherent 36 # view of target code. 37 38 daddu $k0, $k0, $k1 39 nop 40 41 ld $k0, 0($k0) # k0 <- core specific target address 42 dmfc0 $k1, $31, 3 # Restore $k1 from KScratch2 43 44 beqz $k0, wait_loop # Spin in wait loop 45 nop 46 47 jr $k0 48 nop 49 50 nop # NOPs needed here to fill delay slots 51 nop # on endian reversal of previous instructions 52 53 wait_loop: 54 wait 55 nop 56 57 b wait_loop 58 nop 59 60 nop 61 nop 62 ------------------------------------ 63 64 0000000000000000 <reset_vector>: 65 0: 40baf800 dmtc0 k0,c0_desave 66 4: 40bbf803 dmtc0 k1,c0_kscratch2 67 68 8: 401a6000 mfc0 k0,c0_status 69 c: 401b7801 mfc0 k1,c0_ebase 70 71 10: 375a0084 ori k0,k0,0x84 72 14: 337b03ff andi k1,k1,0x3ff 73 74 18: 409a6000 mtc0 k0,c0_status 75 1c: 001bd940 sll k1,k1,0x5 76 77 20: 3c1abfc0 lui k0,0xbfc0 78 24: bc110000 cache 0x11,0(zero) 79 80 28: df5a0078 ld k0,120(k0) 81 2c: 041f0000 synci 0(zero) 82 83 30: 035bd02d daddu k0,k0,k1 84 34: 00000000 nop 85 86 38: df5a0000 ld k0,0(k0) 87 3c: 403bf803 dmfc0 k1,c0_kscratch2 88 89 40: 13400005 beqz k0,58 <wait_loop> 90 44: 00000000 nop 91 92 48: 03400008 jr k0 93 4c: 00000000 nop 94 95 50: 00000000 nop 96 54: 00000000 nop 97 98 0000000000000058 <wait_loop>: 99 58: 42000020 wait 100 5c: 00000000 nop 101 102 60: 1000fffd b 58 <wait_loop> 103 64: 00000000 nop 104 105 68: 00000000 nop 106 6c: 00000000 nop 107 108 */ 109 110 #include <asm/octeon/cvmx-boot-vector.h> 111 112 static unsigned long long _cvmx_bootvector_data[16] = { 113 0x40baf80040bbf803ull, /* patch low order 8-bits if no KScratch*/ 114 0x401a6000401b7801ull, 115 0x375a0084337b03ffull, 116 0x409a6000001bd940ull, 117 0x3c1abfc0bc110000ull, 118 0xdf5a0078041f0000ull, 119 0x035bd02d00000000ull, 120 0xdf5a0000403bf803ull, /* patch low order 8-bits if no KScratch*/ 121 0x1340000500000000ull, 122 0x0340000800000000ull, 123 0x0000000000000000ull, 124 0x4200002000000000ull, 125 0x1000fffd00000000ull, 126 0x0000000000000000ull, 127 OCTEON_BOOT_MOVEABLE_MAGIC1, 128 0 /* To be filled in with address of vector block*/ 129 }; 130 131 /* 2^10 CPUs */ 132 #define VECTOR_TABLE_SIZE (1024 * sizeof(struct cvmx_boot_vector_element)) 133 134 static void cvmx_boot_vector_init(void *mem) 135 { 136 uint64_t kseg0_mem; 137 int i; 138 139 memset(mem, 0, VECTOR_TABLE_SIZE); 140 kseg0_mem = cvmx_ptr_to_phys(mem) | 0x8000000000000000ull; 141 142 for (i = 0; i < 15; i++) { 143 uint64_t v = _cvmx_bootvector_data[i]; 144 145 if (OCTEON_IS_OCTEON1PLUS() && (i == 0 || i == 7)) 146 v &= 0xffffffff00000000ull; /* KScratch not available */ 147 cvmx_write_csr(CVMX_MIO_BOOT_LOC_ADR, i * 8); 148 cvmx_write_csr(CVMX_MIO_BOOT_LOC_DAT, v); 149 } 150 cvmx_write_csr(CVMX_MIO_BOOT_LOC_ADR, 15 * 8); 151 cvmx_write_csr(CVMX_MIO_BOOT_LOC_DAT, kseg0_mem); 152 cvmx_write_csr(CVMX_MIO_BOOT_LOC_CFGX(0), 0x81fc0000); 153 } 154 155 /** 156 * Get a pointer to the per-core table of reset vector pointers 157 * 158 */ 159 struct cvmx_boot_vector_element *cvmx_boot_vector_get(void) 160 { 161 struct cvmx_boot_vector_element *ret; 162 163 ret = cvmx_bootmem_alloc_named_range_once(VECTOR_TABLE_SIZE, 0, 164 (1ull << 32) - 1, 8, "__boot_vector1__", cvmx_boot_vector_init); 165 return ret; 166 } 167 EXPORT_SYMBOL(cvmx_boot_vector_get); 168