1 /* $NetBSD: ibm4xx_machdep.c,v 1.21 2016/12/16 04:27:03 rin Exp $ */ 2 /* Original: ibm40x_machdep.c,v 1.3 2005/01/17 17:19:36 shige Exp $ */ 3 4 /* 5 * Copyright 2001, 2002 Wasabi Systems, Inc. 6 * All rights reserved. 7 * 8 * Written by Eduardo Horvath and Simon Burge for Wasabi Systems, Inc. 9 * 10 * Redistribution and use in source and binary forms, with or without 11 * modification, are permitted provided that the following conditions 12 * are met: 13 * 1. Redistributions of source code must retain the above copyright 14 * notice, this list of conditions and the following disclaimer. 15 * 2. Redistributions in binary form must reproduce the above copyright 16 * notice, this list of conditions and the following disclaimer in the 17 * documentation and/or other materials provided with the distribution. 18 * 3. All advertising materials mentioning features or use of this software 19 * must display the following acknowledgement: 20 * This product includes software developed for the NetBSD Project by 21 * Wasabi Systems, Inc. 22 * 4. The name of Wasabi Systems, Inc. may not be used to endorse 23 * or promote products derived from this software without specific prior 24 * written permission. 25 * 26 * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND 27 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 28 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 29 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL WASABI SYSTEMS, INC 30 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 31 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 32 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 33 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 34 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 35 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 36 * POSSIBILITY OF SUCH DAMAGE. 37 */ 38 39 /* 40 * Copyright (C) 1995, 1996 Wolfgang Solfrank. 41 * Copyright (C) 1995, 1996 TooLs GmbH. 42 * All rights reserved. 43 * 44 * Redistribution and use in source and binary forms, with or without 45 * modification, are permitted provided that the following conditions 46 * are met: 47 * 1. Redistributions of source code must retain the above copyright 48 * notice, this list of conditions and the following disclaimer. 49 * 2. Redistributions in binary form must reproduce the above copyright 50 * notice, this list of conditions and the following disclaimer in the 51 * documentation and/or other materials provided with the distribution. 52 * 3. All advertising materials mentioning features or use of this software 53 * must display the following acknowledgement: 54 * This product includes software developed by TooLs GmbH. 55 * 4. The name of TooLs GmbH may not be used to endorse or promote products 56 * derived from this software without specific prior written permission. 57 * 58 * THIS SOFTWARE IS PROVIDED BY TOOLS GMBH ``AS IS'' AND ANY EXPRESS OR 59 * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES 60 * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 61 * IN NO EVENT SHALL TOOLS GMBH BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, 62 * SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, 63 * PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; 64 * OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, 65 * WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR 66 * OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF 67 * ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. 68 */ 69 70 #include <sys/cdefs.h> 71 __KERNEL_RCSID(0, "$NetBSD: ibm4xx_machdep.c,v 1.21 2016/12/16 04:27:03 rin Exp $"); 72 73 #include "opt_compat_netbsd.h" 74 #include "opt_ddb.h" 75 #include "opt_kgdb.h" 76 #include "opt_ipkdb.h" 77 #include "opt_modular.h" 78 #include "ksyms.h" /* for NKSYMS */ 79 80 #include <sys/param.h> 81 #include <sys/msgbuf.h> 82 #include <sys/proc.h> 83 #include <sys/cpu.h> 84 #include <sys/ksyms.h> 85 86 #include <uvm/uvm_extern.h> 87 88 #if defined(DDB) 89 #include <machine/db_machdep.h> 90 #include <ddb/db_extern.h> 91 #endif 92 93 #if defined(KGDB) 94 #include <sys/kgdb.h> 95 #endif 96 97 #if defined(IPKDB) 98 #include <ipkdb/ipkdb.h> 99 #endif 100 101 #include <machine/powerpc.h> 102 #include <powerpc/pcb.h> 103 #include <machine/trap.h> 104 105 #include <powerpc/spr.h> 106 #include <powerpc/ibm4xx/spr.h> 107 108 #include <powerpc/ibm4xx/cpu.h> 109 110 /* 111 * Global variables used here and there 112 */ 113 paddr_t msgbuf_paddr; 114 vaddr_t msgbuf_vaddr; 115 char msgbuf[MSGBUFSIZE]; 116 117 #if NKSYMS || defined(DDB) || defined(MODULAR) 118 void *startsym, *endsym; 119 #endif 120 121 /* 122 * Trap vectors 123 */ 124 extern const uint32_t defaulttrap[], defaultsize; 125 extern const uint32_t sctrap[], scsize; 126 extern const uint32_t alitrap[], alisize; 127 extern const uint32_t dsitrap[], dsisize; 128 extern const uint32_t isitrap[], isisize; 129 extern const uint32_t mchktrap[], mchksize; 130 extern const uint32_t tlbimiss4xx[], tlbim4size; 131 extern const uint32_t tlbdmiss4xx[], tlbdm4size; 132 extern const uint32_t pitfitwdog[], pitfitwdogsize; 133 extern const uint32_t debugtrap[], debugsize; 134 extern const uint32_t errata51handler[], errata51size; 135 #if defined(DDB) 136 extern const uint32_t ddblow[], ddbsize; 137 #endif 138 #if defined(IPKDB) 139 extern const uint32_t ipkdblow[], ipkdbsize; 140 #endif 141 static const struct exc_info trap_table[] = { 142 { EXC_SC, sctrap, (uintptr_t)&scsize }, 143 { EXC_ALI, alitrap, (uintptr_t)&alisize }, 144 { EXC_DSI, dsitrap, (uintptr_t)&dsisize }, 145 { EXC_ISI, isitrap, (uintptr_t)&isisize }, 146 { EXC_MCHK, mchktrap, (uintptr_t)&mchksize }, 147 { EXC_ITMISS, tlbimiss4xx, (uintptr_t)&tlbim4size }, 148 { EXC_DTMISS, tlbdmiss4xx, (uintptr_t)&tlbdm4size }, 149 { EXC_PIT, pitfitwdog, (uintptr_t)&pitfitwdogsize }, 150 { EXC_DEBUG, debugtrap, (uintptr_t)&debugsize }, 151 { (EXC_DTMISS|EXC_ALI), 152 errata51handler, (uintptr_t)&errata51size }, 153 #if defined(DDB) 154 { EXC_PGM, ddblow, (uintptr_t)&ddbsize }, 155 #endif 156 #if defined(IPKDB) 157 { EXC_PGM, ipkdblow, (uintptr_t)&ipkdbsize }, 158 #endif 159 }; 160 161 /* 162 * Install a trap vector. We cannot use memcpy because the 163 * destination may be zero. 164 */ 165 static void 166 trap_copy(const uint32_t *src, vaddr_t dest, size_t len) 167 { 168 uint32_t *dest_p = (void *)dest; 169 170 while (len > 0) { 171 *dest_p++ = *src++; 172 len -= sizeof(uint32_t); 173 } 174 } 175 176 /* 177 * ibm4xx_init: 178 */ 179 void 180 ibm4xx_init(vaddr_t startkernel, vaddr_t endkernel, void (*handler)(void)) 181 { 182 /* Initialize cache info for memcpy, etc. */ 183 cpu_probe_cache(); 184 185 /* 186 * Initialize current pcb and pmap pointers. 187 */ 188 KASSERT(curcpu() == &cpu_info[0]); 189 KASSERT(lwp0.l_cpu == curcpu()); 190 KASSERT(curlwp == &lwp0); 191 192 curpcb = lwp_getpcb(curlwp); 193 memset(curpcb, 0, sizeof(struct pcb)); 194 195 curpcb->pcb_pm = pmap_kernel(); 196 197 for (uintptr_t exc = EXC_RSVD; exc <= EXC_LAST; exc += 0x100) { 198 trap_copy(defaulttrap, exc, (uintptr_t)&defaultsize); 199 } 200 201 for (size_t i = 0; i < __arraycount(trap_table); i++) { 202 trap_copy(trap_table[i].exc_addr, trap_table[i].exc_vector, 203 trap_table[i].exc_size); 204 } 205 206 __syncicache((void *)EXC_RST, EXC_LAST - EXC_RST + 0x100); 207 208 mtspr(SPR_EVPR, 0); /* Set Exception vector base */ 209 210 /* Handle trap instruction as PGM exception */ 211 mtspr(SPR_DBCR0, mfspr(SPR_DBCR0) & ~DBCR0_TDE); 212 213 /* 214 * external interrupt handler install 215 */ 216 if (handler) 217 ibm4xx_install_extint(handler); 218 219 /* 220 * Now enable translation (and machine checks/recoverable interrupts). 221 */ 222 __asm volatile ("mfmsr %0; ori %0,%0,%1; mtmsr %0; isync" 223 : : "r"(0), "K"(PSL_IR|PSL_DR)); 224 /* XXXX PSL_ME - With ME set kernel gets stuck... */ 225 226 /* 227 * turn on console after enable translation 228 */ 229 consinit(); 230 231 uvm_setpagesize(); 232 233 /* 234 * Initialize pmap module. 235 */ 236 pmap_bootstrap(startkernel, endkernel); 237 238 /* 239 * Let's take all the indirect calls via our stubs and patch 240 * them to be direct calls. 241 */ 242 cpu_fixup_stubs(); 243 244 #if NKSYMS || defined(DDB) || defined(MODULAR) 245 ksyms_addsyms_elf((uintptr_t)endsym - (uintptr_t)startsym, 246 startsym, endsym); 247 #endif 248 } 249 250 void 251 ibm4xx_install_extint(void (*handler)(void)) 252 { 253 extern int extint, extsize; 254 extern u_long extint_call; 255 u_long offset = (u_long)handler - (u_long)&extint_call; 256 int msr; 257 258 #ifdef DIAGNOSTIC 259 if (offset > 0x1ffffff) 260 panic("install_extint: too far away"); 261 #endif 262 __asm volatile ("mfmsr %0; wrteei 0" : "=r"(msr)); 263 extint_call = (extint_call & 0xfc000003) | offset; 264 memcpy((void *)EXC_EXI, &extint, (size_t)&extsize); 265 __syncicache((void *)&extint_call, sizeof extint_call); 266 __syncicache((void *)EXC_EXI, (int)&extsize); 267 __asm volatile ("mtmsr %0" :: "r"(msr)); 268 } 269 270 /* 271 * ibm4xx_cpu_startup: 272 * Machine dependent startup code. 273 */ 274 void 275 ibm4xx_cpu_startup(const char *model) 276 { 277 vaddr_t minaddr, maxaddr; 278 char pbuf[9]; 279 280 KASSERT(curcpu() != NULL); 281 KASSERT(lwp0.l_cpu != NULL); 282 KASSERT(curcpu()->ci_intstk != 0); 283 KASSERT(curcpu()->ci_idepth == -1); 284 285 /* 286 * Initialize error message buffer (at end of core). 287 */ 288 #if 0 /* For some reason this fails... --Artem 289 * Besides, do we really have to put it at the end of core? 290 * Let's use static buffer for now 291 */ 292 if (!(msgbuf_vaddr = uvm_km_alloc(kernel_map, round_page(MSGBUFSIZE), 293 0, UVM_KMF_VAONLY))) 294 panic("startup: no room for message buffer"); 295 for (i = 0; i < btoc(MSGBUFSIZE); i++) 296 pmap_kenter_pa(msgbuf_vaddr + i * PAGE_SIZE, 297 msgbuf_paddr + i * PAGE_SIZE, 298 VM_PROT_READ|VM_PROT_WRITE, 0); 299 initmsgbuf((void *)msgbuf_vaddr, round_page(MSGBUFSIZE)); 300 #else 301 initmsgbuf((void *)msgbuf, round_page(MSGBUFSIZE)); 302 #endif 303 304 printf("%s%s", copyright, version); 305 if (model != NULL) 306 printf("Model: %s\n", model); 307 308 format_bytes(pbuf, sizeof(pbuf), ctob(physmem)); 309 printf("total memory = %s\n", pbuf); 310 311 minaddr = 0; 312 /* 313 * Allocate a submap for physio 314 */ 315 phys_map = uvm_km_suballoc(kernel_map, &minaddr, &maxaddr, 316 VM_PHYS_SIZE, 0, false, NULL); 317 318 /* 319 * No need to allocate an mbuf cluster submap. Mbuf clusters 320 * are allocated via the pool allocator, and we use direct-mapped 321 * pool pages. 322 */ 323 324 format_bytes(pbuf, sizeof(pbuf), ptoa(uvmexp.free)); 325 printf("avail memory = %s\n", pbuf); 326 } 327 328 /* 329 * ibm4xx_dumpsys: 330 * Crash dump handling. 331 */ 332 void 333 ibm4xx_dumpsys(void) 334 { 335 336 printf("dumpsys: TBD\n"); 337 } 338