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
cvmx_boot_vector_init(void * mem)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 availble. */
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 */
cvmx_boot_vector_get(void)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