1 /* $NetBSD: arm32_machdep.c,v 1.44 2004/03/24 15:34:47 atatat Exp $ */ 2 3 /*- 4 * SPDX-License-Identifier: BSD-4-Clause 5 * 6 * Copyright (c) 2004 Olivier Houchard 7 * Copyright (c) 1994-1998 Mark Brinicombe. 8 * Copyright (c) 1994 Brini. 9 * All rights reserved. 10 * 11 * This code is derived from software written for Brini by Mark Brinicombe 12 * 13 * Redistribution and use in source and binary forms, with or without 14 * modification, are permitted provided that the following conditions 15 * are met: 16 * 1. Redistributions of source code must retain the above copyright 17 * notice, this list of conditions and the following disclaimer. 18 * 2. Redistributions in binary form must reproduce the above copyright 19 * notice, this list of conditions and the following disclaimer in the 20 * documentation and/or other materials provided with the distribution. 21 * 3. All advertising materials mentioning features or use of this software 22 * must display the following acknowledgement: 23 * This product includes software developed by Mark Brinicombe 24 * for the NetBSD Project. 25 * 4. The name of the company nor the name of the author may be used to 26 * endorse or promote products derived from this software without specific 27 * prior written permission. 28 * 29 * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR IMPLIED 30 * WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF 31 * MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED. 32 * IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, 33 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES 34 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR 35 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) 36 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 37 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY 38 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF 39 * SUCH DAMAGE. 40 * 41 * Machine dependent functions for kernel setup 42 * 43 * Created : 17/09/94 44 * Updated : 18/04/01 updated for new wscons 45 */ 46 47 #include "opt_ddb.h" 48 #include "opt_kstack_pages.h" 49 #include "opt_platform.h" 50 #include "opt_sched.h" 51 52 #include <sys/cdefs.h> 53 __FBSDID("$FreeBSD$"); 54 55 #include <sys/param.h> 56 #include <sys/buf.h> 57 #include <sys/bus.h> 58 #include <sys/cons.h> 59 #include <sys/cpu.h> 60 #include <sys/devmap.h> 61 #include <sys/efi.h> 62 #include <sys/imgact.h> 63 #include <sys/kdb.h> 64 #include <sys/kernel.h> 65 #include <sys/ktr.h> 66 #include <sys/linker.h> 67 #include <sys/msgbuf.h> 68 #include <sys/physmem.h> 69 #include <sys/reboot.h> 70 #include <sys/rwlock.h> 71 #include <sys/sched.h> 72 #include <sys/syscallsubr.h> 73 #include <sys/sysent.h> 74 #include <sys/sysproto.h> 75 #include <sys/vmmeter.h> 76 77 #include <vm/vm_object.h> 78 #include <vm/vm_page.h> 79 #include <vm/vm_pager.h> 80 81 #include <machine/asm.h> 82 #include <machine/debug_monitor.h> 83 #include <machine/machdep.h> 84 #include <machine/metadata.h> 85 #include <machine/pcb.h> 86 #include <machine/platform.h> 87 #include <machine/sysarch.h> 88 #include <machine/undefined.h> 89 #include <machine/vfp.h> 90 #include <machine/vmparam.h> 91 92 #ifdef FDT 93 #include <dev/fdt/fdt_common.h> 94 #include <machine/ofw_machdep.h> 95 #endif 96 97 #ifdef DEBUG 98 #define debugf(fmt, args...) printf(fmt, ##args) 99 #else 100 #define debugf(fmt, args...) 101 #endif 102 103 #if defined(COMPAT_FREEBSD4) || defined(COMPAT_FREEBSD5) || \ 104 defined(COMPAT_FREEBSD6) || defined(COMPAT_FREEBSD7) || \ 105 defined(COMPAT_FREEBSD9) 106 #error FreeBSD/arm doesn't provide compatibility with releases prior to 10 107 #endif 108 109 110 #if __ARM_ARCH < 6 111 #error FreeBSD requires ARMv6 or later 112 #endif 113 114 struct pcpu __pcpu[MAXCPU]; 115 struct pcpu *pcpup = &__pcpu[0]; 116 117 static struct trapframe proc0_tf; 118 uint32_t cpu_reset_address = 0; 119 int cold = 1; 120 vm_offset_t vector_page; 121 122 /* The address at which the kernel was loaded. Set early in initarm(). */ 123 vm_paddr_t arm_physmem_kernaddr; 124 125 extern int *end; 126 127 #ifdef FDT 128 vm_paddr_t pmap_pa; 129 vm_offset_t systempage; 130 vm_offset_t irqstack; 131 vm_offset_t undstack; 132 vm_offset_t abtstack; 133 #endif /* FDT */ 134 135 #ifdef PLATFORM 136 static delay_func *delay_impl; 137 static void *delay_arg; 138 #endif 139 140 struct kva_md_info kmi; 141 /* 142 * arm32_vector_init: 143 * 144 * Initialize the vector page, and select whether or not to 145 * relocate the vectors. 146 * 147 * NOTE: We expect the vector page to be mapped at its expected 148 * destination. 149 */ 150 151 extern unsigned int page0[], page0_data[]; 152 void 153 arm_vector_init(vm_offset_t va, int which) 154 { 155 unsigned int *vectors = (int *) va; 156 unsigned int *vectors_data = vectors + (page0_data - page0); 157 int vec; 158 159 /* 160 * Loop through the vectors we're taking over, and copy the 161 * vector's insn and data word. 162 */ 163 for (vec = 0; vec < ARM_NVEC; vec++) { 164 if ((which & (1 << vec)) == 0) { 165 /* Don't want to take over this vector. */ 166 continue; 167 } 168 vectors[vec] = page0[vec]; 169 vectors_data[vec] = page0_data[vec]; 170 } 171 172 /* Now sync the vectors. */ 173 icache_sync(va, (ARM_NVEC * 2) * sizeof(u_int)); 174 175 vector_page = va; 176 } 177 178 static void 179 cpu_startup(void *dummy) 180 { 181 struct pcb *pcb = thread0.td_pcb; 182 const unsigned int mbyte = 1024 * 1024; 183 184 identify_arm_cpu(); 185 186 vm_ksubmap_init(&kmi); 187 188 /* 189 * Display the RAM layout. 190 */ 191 printf("real memory = %ju (%ju MB)\n", 192 (uintmax_t)arm32_ptob(realmem), 193 (uintmax_t)arm32_ptob(realmem) / mbyte); 194 printf("avail memory = %ju (%ju MB)\n", 195 (uintmax_t)arm32_ptob(vm_free_count()), 196 (uintmax_t)arm32_ptob(vm_free_count()) / mbyte); 197 if (bootverbose) { 198 physmem_print_tables(); 199 devmap_print_table(); 200 } 201 202 bufinit(); 203 vm_pager_bufferinit(); 204 pcb->pcb_regs.sf_sp = (u_int)thread0.td_kstack + 205 USPACE_SVC_STACK_TOP; 206 pmap_set_pcb_pagedir(kernel_pmap, pcb); 207 } 208 209 SYSINIT(cpu, SI_SUB_CPU, SI_ORDER_FIRST, cpu_startup, NULL); 210 211 /* 212 * Flush the D-cache for non-DMA I/O so that the I-cache can 213 * be made coherent later. 214 */ 215 void 216 cpu_flush_dcache(void *ptr, size_t len) 217 { 218 219 dcache_wb_poc((vm_offset_t)ptr, (vm_paddr_t)vtophys(ptr), len); 220 } 221 222 /* Get current clock frequency for the given cpu id. */ 223 int 224 cpu_est_clockrate(int cpu_id, uint64_t *rate) 225 { 226 struct pcpu *pc; 227 228 pc = pcpu_find(cpu_id); 229 if (pc == NULL || rate == NULL) 230 return (EINVAL); 231 232 if (pc->pc_clock == 0) 233 return (EOPNOTSUPP); 234 235 *rate = pc->pc_clock; 236 237 return (0); 238 } 239 240 void 241 cpu_idle(int busy) 242 { 243 244 CTR2(KTR_SPARE2, "cpu_idle(%d) at %d", busy, curcpu); 245 spinlock_enter(); 246 if (!busy) 247 cpu_idleclock(); 248 if (!sched_runnable()) 249 cpu_sleep(0); 250 if (!busy) 251 cpu_activeclock(); 252 spinlock_exit(); 253 CTR2(KTR_SPARE2, "cpu_idle(%d) at %d done", busy, curcpu); 254 } 255 256 int 257 cpu_idle_wakeup(int cpu) 258 { 259 260 return (0); 261 } 262 263 void 264 cpu_initclocks(void) 265 { 266 267 #ifdef SMP 268 if (PCPU_GET(cpuid) == 0) 269 cpu_initclocks_bsp(); 270 else 271 cpu_initclocks_ap(); 272 #else 273 cpu_initclocks_bsp(); 274 #endif 275 } 276 277 #ifdef PLATFORM 278 void 279 arm_set_delay(delay_func *impl, void *arg) 280 { 281 282 KASSERT(impl != NULL, ("No DELAY implementation")); 283 delay_impl = impl; 284 delay_arg = arg; 285 } 286 287 void 288 DELAY(int usec) 289 { 290 291 TSENTER(); 292 delay_impl(usec, delay_arg); 293 TSEXIT(); 294 } 295 #endif 296 297 void 298 cpu_pcpu_init(struct pcpu *pcpu, int cpuid, size_t size) 299 { 300 301 pcpu->pc_mpidr = 0xffffffff; 302 } 303 304 void 305 spinlock_enter(void) 306 { 307 struct thread *td; 308 register_t cspr; 309 310 td = curthread; 311 if (td->td_md.md_spinlock_count == 0) { 312 cspr = disable_interrupts(PSR_I | PSR_F); 313 td->td_md.md_spinlock_count = 1; 314 td->td_md.md_saved_cspr = cspr; 315 critical_enter(); 316 } else 317 td->td_md.md_spinlock_count++; 318 } 319 320 void 321 spinlock_exit(void) 322 { 323 struct thread *td; 324 register_t cspr; 325 326 td = curthread; 327 cspr = td->td_md.md_saved_cspr; 328 td->td_md.md_spinlock_count--; 329 if (td->td_md.md_spinlock_count == 0) { 330 critical_exit(); 331 restore_interrupts(cspr); 332 } 333 } 334 335 /* 336 * Clear registers on exec 337 */ 338 void 339 exec_setregs(struct thread *td, struct image_params *imgp, uintptr_t stack) 340 { 341 struct trapframe *tf = td->td_frame; 342 343 memset(tf, 0, sizeof(*tf)); 344 tf->tf_usr_sp = stack; 345 tf->tf_usr_lr = imgp->entry_addr; 346 tf->tf_svc_lr = 0x77777777; 347 tf->tf_pc = imgp->entry_addr; 348 tf->tf_spsr = PSR_USR32_MODE; 349 if ((register_t)imgp->entry_addr & 1) 350 tf->tf_spsr |= PSR_T; 351 } 352 353 #ifdef VFP 354 /* 355 * Get machine VFP context. 356 */ 357 void 358 get_vfpcontext(struct thread *td, mcontext_vfp_t *vfp) 359 { 360 struct pcb *pcb; 361 362 pcb = td->td_pcb; 363 if (td == curthread) { 364 critical_enter(); 365 vfp_store(&pcb->pcb_vfpstate, false); 366 critical_exit(); 367 } else 368 MPASS(TD_IS_SUSPENDED(td)); 369 memcpy(vfp->mcv_reg, pcb->pcb_vfpstate.reg, 370 sizeof(vfp->mcv_reg)); 371 vfp->mcv_fpscr = pcb->pcb_vfpstate.fpscr; 372 } 373 374 /* 375 * Set machine VFP context. 376 */ 377 void 378 set_vfpcontext(struct thread *td, mcontext_vfp_t *vfp) 379 { 380 struct pcb *pcb; 381 382 pcb = td->td_pcb; 383 if (td == curthread) { 384 critical_enter(); 385 vfp_discard(td); 386 critical_exit(); 387 } else 388 MPASS(TD_IS_SUSPENDED(td)); 389 memcpy(pcb->pcb_vfpstate.reg, vfp->mcv_reg, 390 sizeof(pcb->pcb_vfpstate.reg)); 391 pcb->pcb_vfpstate.fpscr = vfp->mcv_fpscr; 392 } 393 #endif 394 395 int 396 arm_get_vfpstate(struct thread *td, void *args) 397 { 398 int rv; 399 struct arm_get_vfpstate_args ua; 400 mcontext_vfp_t mcontext_vfp; 401 402 rv = copyin(args, &ua, sizeof(ua)); 403 if (rv != 0) 404 return (rv); 405 if (ua.mc_vfp_size != sizeof(mcontext_vfp_t)) 406 return (EINVAL); 407 #ifdef VFP 408 get_vfpcontext(td, &mcontext_vfp); 409 #else 410 bzero(&mcontext_vfp, sizeof(mcontext_vfp)); 411 #endif 412 413 rv = copyout(&mcontext_vfp, ua.mc_vfp, sizeof(mcontext_vfp)); 414 if (rv != 0) 415 return (rv); 416 return (0); 417 } 418 419 /* 420 * Get machine context. 421 */ 422 int 423 get_mcontext(struct thread *td, mcontext_t *mcp, int clear_ret) 424 { 425 struct trapframe *tf = td->td_frame; 426 __greg_t *gr = mcp->__gregs; 427 428 if (clear_ret & GET_MC_CLEAR_RET) { 429 gr[_REG_R0] = 0; 430 gr[_REG_CPSR] = tf->tf_spsr & ~PSR_C; 431 } else { 432 gr[_REG_R0] = tf->tf_r0; 433 gr[_REG_CPSR] = tf->tf_spsr; 434 } 435 gr[_REG_R1] = tf->tf_r1; 436 gr[_REG_R2] = tf->tf_r2; 437 gr[_REG_R3] = tf->tf_r3; 438 gr[_REG_R4] = tf->tf_r4; 439 gr[_REG_R5] = tf->tf_r5; 440 gr[_REG_R6] = tf->tf_r6; 441 gr[_REG_R7] = tf->tf_r7; 442 gr[_REG_R8] = tf->tf_r8; 443 gr[_REG_R9] = tf->tf_r9; 444 gr[_REG_R10] = tf->tf_r10; 445 gr[_REG_R11] = tf->tf_r11; 446 gr[_REG_R12] = tf->tf_r12; 447 gr[_REG_SP] = tf->tf_usr_sp; 448 gr[_REG_LR] = tf->tf_usr_lr; 449 gr[_REG_PC] = tf->tf_pc; 450 451 mcp->mc_vfp_size = 0; 452 mcp->mc_vfp_ptr = NULL; 453 memset(&mcp->mc_spare, 0, sizeof(mcp->mc_spare)); 454 455 return (0); 456 } 457 458 /* 459 * Set machine context. 460 * 461 * However, we don't set any but the user modifiable flags, and we won't 462 * touch the cs selector. 463 */ 464 int 465 set_mcontext(struct thread *td, mcontext_t *mcp) 466 { 467 mcontext_vfp_t mc_vfp, *vfp; 468 struct trapframe *tf = td->td_frame; 469 const __greg_t *gr = mcp->__gregs; 470 int spsr; 471 472 /* 473 * Make sure the processor mode has not been tampered with and 474 * interrupts have not been disabled. 475 */ 476 spsr = gr[_REG_CPSR]; 477 if ((spsr & PSR_MODE) != PSR_USR32_MODE || 478 (spsr & (PSR_I | PSR_F)) != 0) 479 return (EINVAL); 480 481 #ifdef WITNESS 482 if (mcp->mc_vfp_size != 0 && mcp->mc_vfp_size != sizeof(mc_vfp)) { 483 printf("%s: %s: Malformed mc_vfp_size: %d (0x%08X)\n", 484 td->td_proc->p_comm, __func__, 485 mcp->mc_vfp_size, mcp->mc_vfp_size); 486 } else if (mcp->mc_vfp_size != 0 && mcp->mc_vfp_ptr == NULL) { 487 printf("%s: %s: c_vfp_size != 0 but mc_vfp_ptr == NULL\n", 488 td->td_proc->p_comm, __func__); 489 } 490 #endif 491 492 if (mcp->mc_vfp_size == sizeof(mc_vfp) && mcp->mc_vfp_ptr != NULL) { 493 if (copyin(mcp->mc_vfp_ptr, &mc_vfp, sizeof(mc_vfp)) != 0) 494 return (EFAULT); 495 vfp = &mc_vfp; 496 } else { 497 vfp = NULL; 498 } 499 500 tf->tf_r0 = gr[_REG_R0]; 501 tf->tf_r1 = gr[_REG_R1]; 502 tf->tf_r2 = gr[_REG_R2]; 503 tf->tf_r3 = gr[_REG_R3]; 504 tf->tf_r4 = gr[_REG_R4]; 505 tf->tf_r5 = gr[_REG_R5]; 506 tf->tf_r6 = gr[_REG_R6]; 507 tf->tf_r7 = gr[_REG_R7]; 508 tf->tf_r8 = gr[_REG_R8]; 509 tf->tf_r9 = gr[_REG_R9]; 510 tf->tf_r10 = gr[_REG_R10]; 511 tf->tf_r11 = gr[_REG_R11]; 512 tf->tf_r12 = gr[_REG_R12]; 513 tf->tf_usr_sp = gr[_REG_SP]; 514 tf->tf_usr_lr = gr[_REG_LR]; 515 tf->tf_pc = gr[_REG_PC]; 516 tf->tf_spsr = gr[_REG_CPSR]; 517 #ifdef VFP 518 if (vfp != NULL) 519 set_vfpcontext(td, vfp); 520 #endif 521 return (0); 522 } 523 524 void 525 sendsig(catcher, ksi, mask) 526 sig_t catcher; 527 ksiginfo_t *ksi; 528 sigset_t *mask; 529 { 530 struct thread *td; 531 struct proc *p; 532 struct trapframe *tf; 533 struct sigframe *fp, frame; 534 struct sigacts *psp; 535 struct sysentvec *sysent; 536 int onstack; 537 int sig; 538 int code; 539 540 td = curthread; 541 p = td->td_proc; 542 PROC_LOCK_ASSERT(p, MA_OWNED); 543 sig = ksi->ksi_signo; 544 code = ksi->ksi_code; 545 psp = p->p_sigacts; 546 mtx_assert(&psp->ps_mtx, MA_OWNED); 547 tf = td->td_frame; 548 onstack = sigonstack(tf->tf_usr_sp); 549 550 CTR4(KTR_SIG, "sendsig: td=%p (%s) catcher=%p sig=%d", td, p->p_comm, 551 catcher, sig); 552 553 /* Allocate and validate space for the signal handler context. */ 554 if ((td->td_pflags & TDP_ALTSTACK) != 0 && !(onstack) && 555 SIGISMEMBER(psp->ps_sigonstack, sig)) { 556 fp = (struct sigframe *)((uintptr_t)td->td_sigstk.ss_sp + 557 td->td_sigstk.ss_size); 558 #if defined(COMPAT_43) 559 td->td_sigstk.ss_flags |= SS_ONSTACK; 560 #endif 561 } else 562 fp = (struct sigframe *)td->td_frame->tf_usr_sp; 563 564 /* make room on the stack */ 565 fp--; 566 567 /* make the stack aligned */ 568 fp = (struct sigframe *)STACKALIGN(fp); 569 /* Populate the siginfo frame. */ 570 bzero(&frame, sizeof(frame)); 571 get_mcontext(td, &frame.sf_uc.uc_mcontext, 0); 572 #ifdef VFP 573 get_vfpcontext(td, &frame.sf_vfp); 574 frame.sf_uc.uc_mcontext.mc_vfp_size = sizeof(fp->sf_vfp); 575 frame.sf_uc.uc_mcontext.mc_vfp_ptr = &fp->sf_vfp; 576 #else 577 frame.sf_uc.uc_mcontext.mc_vfp_size = 0; 578 frame.sf_uc.uc_mcontext.mc_vfp_ptr = NULL; 579 #endif 580 frame.sf_si = ksi->ksi_info; 581 frame.sf_uc.uc_sigmask = *mask; 582 frame.sf_uc.uc_stack = td->td_sigstk; 583 frame.sf_uc.uc_stack.ss_flags = (td->td_pflags & TDP_ALTSTACK) != 0 ? 584 (onstack ? SS_ONSTACK : 0) : SS_DISABLE; 585 mtx_unlock(&psp->ps_mtx); 586 PROC_UNLOCK(td->td_proc); 587 588 /* Copy the sigframe out to the user's stack. */ 589 if (copyout(&frame, fp, sizeof(*fp)) != 0) { 590 /* Process has trashed its stack. Kill it. */ 591 CTR2(KTR_SIG, "sendsig: sigexit td=%p fp=%p", td, fp); 592 PROC_LOCK(p); 593 sigexit(td, SIGILL); 594 } 595 596 /* 597 * Build context to run handler in. We invoke the handler 598 * directly, only returning via the trampoline. Note the 599 * trampoline version numbers are coordinated with machine- 600 * dependent code in libc. 601 */ 602 603 tf->tf_r0 = sig; 604 tf->tf_r1 = (register_t)&fp->sf_si; 605 tf->tf_r2 = (register_t)&fp->sf_uc; 606 607 /* the trampoline uses r5 as the uc address */ 608 tf->tf_r5 = (register_t)&fp->sf_uc; 609 tf->tf_pc = (register_t)catcher; 610 tf->tf_usr_sp = (register_t)fp; 611 sysent = p->p_sysent; 612 if (sysent->sv_sigcode_base != 0) 613 tf->tf_usr_lr = (register_t)sysent->sv_sigcode_base; 614 else 615 tf->tf_usr_lr = (register_t)(sysent->sv_psstrings - 616 *(sysent->sv_szsigcode)); 617 /* Set the mode to enter in the signal handler */ 618 #if __ARM_ARCH >= 7 619 if ((register_t)catcher & 1) 620 tf->tf_spsr |= PSR_T; 621 else 622 tf->tf_spsr &= ~PSR_T; 623 #endif 624 625 CTR3(KTR_SIG, "sendsig: return td=%p pc=%#x sp=%#x", td, tf->tf_usr_lr, 626 tf->tf_usr_sp); 627 628 PROC_LOCK(p); 629 mtx_lock(&psp->ps_mtx); 630 } 631 632 int 633 sys_sigreturn(td, uap) 634 struct thread *td; 635 struct sigreturn_args /* { 636 const struct __ucontext *sigcntxp; 637 } */ *uap; 638 { 639 ucontext_t uc; 640 int error; 641 642 if (uap == NULL) 643 return (EFAULT); 644 if (copyin(uap->sigcntxp, &uc, sizeof(uc))) 645 return (EFAULT); 646 /* Restore register context. */ 647 error = set_mcontext(td, &uc.uc_mcontext); 648 if (error != 0) 649 return (error); 650 651 /* Restore signal mask. */ 652 kern_sigprocmask(td, SIG_SETMASK, &uc.uc_sigmask, NULL, 0); 653 654 return (EJUSTRETURN); 655 } 656 657 /* 658 * Construct a PCB from a trapframe. This is called from kdb_trap() where 659 * we want to start a backtrace from the function that caused us to enter 660 * the debugger. We have the context in the trapframe, but base the trace 661 * on the PCB. The PCB doesn't have to be perfect, as long as it contains 662 * enough for a backtrace. 663 */ 664 void 665 makectx(struct trapframe *tf, struct pcb *pcb) 666 { 667 pcb->pcb_regs.sf_r4 = tf->tf_r4; 668 pcb->pcb_regs.sf_r5 = tf->tf_r5; 669 pcb->pcb_regs.sf_r6 = tf->tf_r6; 670 pcb->pcb_regs.sf_r7 = tf->tf_r7; 671 pcb->pcb_regs.sf_r8 = tf->tf_r8; 672 pcb->pcb_regs.sf_r9 = tf->tf_r9; 673 pcb->pcb_regs.sf_r10 = tf->tf_r10; 674 pcb->pcb_regs.sf_r11 = tf->tf_r11; 675 pcb->pcb_regs.sf_r12 = tf->tf_r12; 676 pcb->pcb_regs.sf_pc = tf->tf_pc; 677 pcb->pcb_regs.sf_lr = tf->tf_usr_lr; 678 pcb->pcb_regs.sf_sp = tf->tf_usr_sp; 679 } 680 681 void 682 pcpu0_init(void) 683 { 684 set_curthread(&thread0); 685 pcpu_init(pcpup, 0, sizeof(struct pcpu)); 686 pcpup->pc_mpidr = cp15_mpidr_get() & 0xFFFFFF; 687 PCPU_SET(curthread, &thread0); 688 } 689 690 /* 691 * Initialize proc0 692 */ 693 void 694 init_proc0(vm_offset_t kstack) 695 { 696 proc_linkup0(&proc0, &thread0); 697 thread0.td_kstack = kstack; 698 thread0.td_kstack_pages = kstack_pages; 699 thread0.td_pcb = (struct pcb *)(thread0.td_kstack + 700 thread0.td_kstack_pages * PAGE_SIZE) - 1; 701 thread0.td_pcb->pcb_flags = 0; 702 thread0.td_pcb->pcb_vfpcpu = -1; 703 thread0.td_pcb->pcb_vfpstate.fpscr = VFPSCR_DN; 704 thread0.td_frame = &proc0_tf; 705 pcpup->pc_curpcb = thread0.td_pcb; 706 } 707 708 void 709 set_stackptrs(int cpu) 710 { 711 712 set_stackptr(PSR_IRQ32_MODE, 713 irqstack + ((IRQ_STACK_SIZE * PAGE_SIZE) * (cpu + 1))); 714 set_stackptr(PSR_ABT32_MODE, 715 abtstack + ((ABT_STACK_SIZE * PAGE_SIZE) * (cpu + 1))); 716 set_stackptr(PSR_UND32_MODE, 717 undstack + ((UND_STACK_SIZE * PAGE_SIZE) * (cpu + 1))); 718 } 719 720 static void 721 arm_kdb_init(void) 722 { 723 724 kdb_init(); 725 #ifdef KDB 726 if (boothowto & RB_KDB) 727 kdb_enter(KDB_WHY_BOOTFLAGS, "Boot flags requested debugger"); 728 #endif 729 } 730 731 #ifdef FDT 732 void * 733 initarm(struct arm_boot_params *abp) 734 { 735 struct mem_region mem_regions[FDT_MEM_REGIONS]; 736 vm_paddr_t lastaddr; 737 vm_offset_t dtbp, kernelstack, dpcpu; 738 char *env; 739 void *kmdp; 740 int err_devmap, mem_regions_sz; 741 phandle_t root; 742 char dts_version[255]; 743 #ifdef EFI 744 struct efi_map_header *efihdr; 745 #endif 746 747 /* get last allocated physical address */ 748 arm_physmem_kernaddr = abp->abp_physaddr; 749 lastaddr = parse_boot_param(abp) - KERNVIRTADDR + arm_physmem_kernaddr; 750 751 set_cpufuncs(); 752 cpuinfo_init(); 753 754 /* 755 * Find the dtb passed in by the boot loader. 756 */ 757 kmdp = preload_search_by_type("elf kernel"); 758 dtbp = MD_FETCH(kmdp, MODINFOMD_DTBP, vm_offset_t); 759 #if defined(FDT_DTB_STATIC) 760 /* 761 * In case the device tree blob was not retrieved (from metadata) try 762 * to use the statically embedded one. 763 */ 764 if (dtbp == (vm_offset_t)NULL) 765 dtbp = (vm_offset_t)&fdt_static_dtb; 766 #endif 767 768 if (OF_install(OFW_FDT, 0) == FALSE) 769 panic("Cannot install FDT"); 770 771 if (OF_init((void *)dtbp) != 0) 772 panic("OF_init failed with the found device tree"); 773 774 #if defined(LINUX_BOOT_ABI) 775 arm_parse_fdt_bootargs(); 776 #endif 777 778 #ifdef EFI 779 efihdr = (struct efi_map_header *)preload_search_info(kmdp, 780 MODINFO_METADATA | MODINFOMD_EFI_MAP); 781 if (efihdr != NULL) { 782 arm_add_efi_map_entries(efihdr, mem_regions, &mem_regions_sz); 783 } else 784 #endif 785 { 786 /* Grab physical memory regions information from device tree. */ 787 if (fdt_get_mem_regions(mem_regions, &mem_regions_sz,NULL) != 0) 788 panic("Cannot get physical memory regions"); 789 } 790 physmem_hardware_regions(mem_regions, mem_regions_sz); 791 792 /* Grab reserved memory regions information from device tree. */ 793 if (fdt_get_reserved_regions(mem_regions, &mem_regions_sz) == 0) 794 physmem_exclude_regions(mem_regions, mem_regions_sz, 795 EXFLAG_NODUMP | EXFLAG_NOALLOC); 796 797 /* 798 * Set TEX remapping registers. 799 * Setup kernel page tables and switch to kernel L1 page table. 800 */ 801 pmap_set_tex(); 802 pmap_bootstrap_prepare(lastaddr); 803 804 /* 805 * If EARLY_PRINTF support is enabled, we need to re-establish the 806 * mapping after pmap_bootstrap_prepare() switches to new page tables. 807 * Note that we can only do the remapping if the VA is outside the 808 * kernel, now that we have real virtual (not VA=PA) mappings in effect. 809 * Early printf does not work between the time pmap_set_tex() does 810 * cp15_prrr_set() and this code remaps the VA. 811 */ 812 #if defined(EARLY_PRINTF) && defined(SOCDEV_PA) && defined(SOCDEV_VA) && SOCDEV_VA < KERNBASE 813 pmap_preboot_map_attr(SOCDEV_PA, SOCDEV_VA, 1024 * 1024, 814 VM_PROT_READ | VM_PROT_WRITE, VM_MEMATTR_DEVICE); 815 #endif 816 817 /* 818 * Now that proper page tables are installed, call cpu_setup() to enable 819 * instruction and data caches and other chip-specific features. 820 */ 821 cpu_setup(); 822 823 /* Platform-specific initialisation */ 824 platform_probe_and_attach(); 825 pcpu0_init(); 826 827 /* Do basic tuning, hz etc */ 828 init_param1(); 829 830 /* 831 * Allocate a page for the system page mapped to 0xffff0000 832 * This page will just contain the system vectors and can be 833 * shared by all processes. 834 */ 835 systempage = pmap_preboot_get_pages(1); 836 837 /* Map the vector page. */ 838 pmap_preboot_map_pages(systempage, ARM_VECTORS_HIGH, 1); 839 if (virtual_end >= ARM_VECTORS_HIGH) 840 virtual_end = ARM_VECTORS_HIGH - 1; 841 842 /* Allocate dynamic per-cpu area. */ 843 dpcpu = pmap_preboot_get_vpages(DPCPU_SIZE / PAGE_SIZE); 844 dpcpu_init((void *)dpcpu, 0); 845 846 /* Allocate stacks for all modes */ 847 irqstack = pmap_preboot_get_vpages(IRQ_STACK_SIZE * MAXCPU); 848 abtstack = pmap_preboot_get_vpages(ABT_STACK_SIZE * MAXCPU); 849 undstack = pmap_preboot_get_vpages(UND_STACK_SIZE * MAXCPU ); 850 kernelstack = pmap_preboot_get_vpages(kstack_pages); 851 852 /* Allocate message buffer. */ 853 msgbufp = (void *)pmap_preboot_get_vpages( 854 round_page(msgbufsize) / PAGE_SIZE); 855 856 /* 857 * Pages were allocated during the secondary bootstrap for the 858 * stacks for different CPU modes. 859 * We must now set the r13 registers in the different CPU modes to 860 * point to these stacks. 861 * Since the ARM stacks use STMFD etc. we must set r13 to the top end 862 * of the stack memory. 863 */ 864 set_stackptrs(0); 865 mutex_init(); 866 867 /* Establish static device mappings. */ 868 err_devmap = platform_devmap_init(); 869 devmap_bootstrap(0, NULL); 870 vm_max_kernel_address = platform_lastaddr(); 871 872 /* 873 * Only after the SOC registers block is mapped we can perform device 874 * tree fixups, as they may attempt to read parameters from hardware. 875 */ 876 OF_interpret("perform-fixup", 0); 877 platform_gpio_init(); 878 cninit(); 879 880 /* 881 * If we made a mapping for EARLY_PRINTF after pmap_bootstrap_prepare(), 882 * undo it now that the normal console printf works. 883 */ 884 #if defined(EARLY_PRINTF) && defined(SOCDEV_PA) && defined(SOCDEV_VA) && SOCDEV_VA < KERNBASE 885 pmap_kremove(SOCDEV_VA); 886 #endif 887 888 debugf("initarm: console initialized\n"); 889 debugf(" arg1 kmdp = 0x%08x\n", (uint32_t)kmdp); 890 debugf(" boothowto = 0x%08x\n", boothowto); 891 debugf(" dtbp = 0x%08x\n", (uint32_t)dtbp); 892 debugf(" lastaddr1: 0x%08x\n", lastaddr); 893 arm_print_kenv(); 894 895 env = kern_getenv("kernelname"); 896 if (env != NULL) 897 strlcpy(kernelname, env, sizeof(kernelname)); 898 899 if (err_devmap != 0) 900 printf("WARNING: could not fully configure devmap, error=%d\n", 901 err_devmap); 902 903 platform_late_init(); 904 905 root = OF_finddevice("/"); 906 if (OF_getprop(root, "freebsd,dts-version", dts_version, sizeof(dts_version)) > 0) { 907 if (strcmp(LINUX_DTS_VERSION, dts_version) != 0) 908 printf("WARNING: DTB version is %s while kernel expects %s, " 909 "please update the DTB in the ESP\n", 910 dts_version, 911 LINUX_DTS_VERSION); 912 } else { 913 printf("WARNING: Cannot find freebsd,dts-version property, " 914 "cannot check DTB compliance\n"); 915 } 916 917 /* 918 * We must now clean the cache again.... 919 * Cleaning may be done by reading new data to displace any 920 * dirty data in the cache. This will have happened in cpu_setttb() 921 * but since we are boot strapping the addresses used for the read 922 * may have just been remapped and thus the cache could be out 923 * of sync. A re-clean after the switch will cure this. 924 * After booting there are no gross relocations of the kernel thus 925 * this problem will not occur after initarm(). 926 */ 927 /* Set stack for exception handlers */ 928 undefined_init(); 929 init_proc0(kernelstack); 930 arm_vector_init(ARM_VECTORS_HIGH, ARM_VEC_ALL); 931 enable_interrupts(PSR_A); 932 pmap_bootstrap(0); 933 934 /* Exclude the kernel (and all the things we allocated which immediately 935 * follow the kernel) from the VM allocation pool but not from crash 936 * dumps. virtual_avail is a global variable which tracks the kva we've 937 * "allocated" while setting up pmaps. 938 * 939 * Prepare the list of physical memory available to the vm subsystem. 940 */ 941 physmem_exclude_region(abp->abp_physaddr, 942 pmap_preboot_get_pages(0) - abp->abp_physaddr, EXFLAG_NOALLOC); 943 physmem_init_kernel_globals(); 944 945 init_param2(physmem); 946 /* Init message buffer. */ 947 msgbufinit(msgbufp, msgbufsize); 948 dbg_monitor_init(); 949 arm_kdb_init(); 950 /* Apply possible BP hardening. */ 951 cpuinfo_init_bp_hardening(); 952 return ((void *)STACKALIGN(thread0.td_pcb)); 953 954 } 955 #endif /* FDT */ 956