locore.h revision 1.1.4.3
1 1.1.4.2 tls /* $NetBSD: locore.h,v 1.1.4.3 2017/12/03 11:35:44 jdolecek Exp $ */ 2 1.1.4.2 tls 3 1.1.4.2 tls /*- 4 1.1.4.2 tls * Copyright (c) 2014 The NetBSD Foundation, Inc. 5 1.1.4.2 tls * All rights reserved. 6 1.1.4.2 tls * 7 1.1.4.2 tls * This code is derived from software contributed to The NetBSD Foundation 8 1.1.4.2 tls * by Matt Thomas of 3am Software Foundry. 9 1.1.4.2 tls * 10 1.1.4.2 tls * Redistribution and use in source and binary forms, with or without 11 1.1.4.2 tls * modification, are permitted provided that the following conditions 12 1.1.4.2 tls * are met: 13 1.1.4.2 tls * 1. Redistributions of source code must retain the above copyright 14 1.1.4.2 tls * notice, this list of conditions and the following disclaimer. 15 1.1.4.2 tls * 2. Redistributions in binary form must reproduce the above copyright 16 1.1.4.2 tls * notice, this list of conditions and the following disclaimer in the 17 1.1.4.2 tls * documentation and/or other materials provided with the distribution. 18 1.1.4.2 tls * 19 1.1.4.2 tls * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS 20 1.1.4.2 tls * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED 21 1.1.4.2 tls * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR 22 1.1.4.2 tls * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS 23 1.1.4.2 tls * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR 24 1.1.4.2 tls * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF 25 1.1.4.2 tls * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS 26 1.1.4.2 tls * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN 27 1.1.4.2 tls * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) 28 1.1.4.2 tls * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 29 1.1.4.2 tls * POSSIBILITY OF SUCH DAMAGE. 30 1.1.4.2 tls */ 31 1.1.4.2 tls 32 1.1.4.2 tls #ifndef _AARCH64_LOCORE_H_ 33 1.1.4.2 tls #define _AARCH64_LOCORE_H_ 34 1.1.4.2 tls 35 1.1.4.2 tls #ifdef __aarch64__ 36 1.1.4.2 tls 37 1.1.4.2 tls #include <sys/types.h> 38 1.1.4.2 tls 39 1.1.4.2 tls #include <sys/cpu.h> 40 1.1.4.2 tls #include <sys/lwp.h> 41 1.1.4.2 tls #include <sys/bus.h> 42 1.1.4.2 tls 43 1.1.4.2 tls #include <aarch64/armreg.h> 44 1.1.4.2 tls #include <aarch64/frame.h> 45 1.1.4.2 tls 46 1.1.4.2 tls struct mainbus_attach_args { 47 1.1.4.2 tls const char *mba_name; 48 1.1.4.2 tls bus_space_tag_t mba_memt; 49 1.1.4.2 tls bus_dma_tag_t mba_dmat; 50 1.1.4.2 tls bus_addr_t mba_addr; 51 1.1.4.2 tls bus_size_t mba_size; 52 1.1.4.2 tls int mba_intr; 53 1.1.4.2 tls int mba_intrbase; 54 1.1.4.2 tls int mba_package; 55 1.1.4.2 tls }; 56 1.1.4.2 tls 57 1.1.4.2 tls void userret(struct lwp *, struct trapframe *); 58 1.1.4.2 tls void lwp_trampoline(void); 59 1.1.4.2 tls void cpu_dosoftints(void); 60 1.1.4.2 tls void dosoftints(void); 61 1.1.4.2 tls void cpu_switchto_softint(struct lwp *, int); 62 1.1.4.2 tls void cpu_send_ipi(struct cpu_info *, int); 63 1.1.4.2 tls 64 1.1.4.2 tls extern paddr_t physical_start; 65 1.1.4.2 tls extern paddr_t physical_end; 66 1.1.4.2 tls 67 1.1.4.2 tls extern const pcu_ops_t pcu_fpu_ops; 68 1.1.4.2 tls 69 1.1.4.2 tls static inline bool 70 1.1.4.2 tls fpu_used_p(lwp_t *l) 71 1.1.4.2 tls { 72 1.1.4.3 jdolecek return pcu_valid_p(&pcu_fpu_ops, l); 73 1.1.4.2 tls } 74 1.1.4.2 tls 75 1.1.4.2 tls static inline void 76 1.1.4.2 tls fpu_discard(lwp_t *l, bool usesw) 77 1.1.4.2 tls { 78 1.1.4.3 jdolecek pcu_discard(&pcu_fpu_ops, l, usesw); 79 1.1.4.2 tls } 80 1.1.4.2 tls 81 1.1.4.2 tls static inline void 82 1.1.4.2 tls fpu_save(lwp_t *l) 83 1.1.4.2 tls { 84 1.1.4.3 jdolecek pcu_save(&pcu_fpu_ops, l); 85 1.1.4.2 tls } 86 1.1.4.2 tls 87 1.1.4.2 tls static inline void cpsie(register_t psw) __attribute__((__unused__)); 88 1.1.4.2 tls static inline register_t cpsid(register_t psw) __attribute__((__unused__)); 89 1.1.4.2 tls 90 1.1.4.2 tls static inline void 91 1.1.4.2 tls cpsie(register_t psw) 92 1.1.4.2 tls { 93 1.1.4.2 tls if (!__builtin_constant_p(psw)) { 94 1.1.4.2 tls reg_daif_write(psw); 95 1.1.4.2 tls } else { 96 1.1.4.2 tls reg_daifset_write(psw); 97 1.1.4.2 tls } 98 1.1.4.2 tls } 99 1.1.4.2 tls 100 1.1.4.2 tls static inline void 101 1.1.4.2 tls enable_interrupts(register_t psw) 102 1.1.4.2 tls { 103 1.1.4.2 tls reg_daif_write(psw); 104 1.1.4.2 tls } 105 1.1.4.2 tls 106 1.1.4.2 tls static inline register_t 107 1.1.4.2 tls cpsid(register_t psw) 108 1.1.4.2 tls { 109 1.1.4.2 tls register_t oldpsw = reg_daif_read(); 110 1.1.4.2 tls if (!__builtin_constant_p(psw)) { 111 1.1.4.2 tls reg_daif_write(oldpsw & ~psw); 112 1.1.4.2 tls } else { 113 1.1.4.2 tls reg_daifclr_write(psw); 114 1.1.4.2 tls } 115 1.1.4.2 tls return oldpsw; 116 1.1.4.2 tls } 117 1.1.4.2 tls 118 1.1.4.2 tls static const paddr_t VTOPHYS_FAILED = (paddr_t) -1L; 119 1.1.4.2 tls 120 1.1.4.2 tls static inline paddr_t 121 1.1.4.2 tls vtophys(vaddr_t va) 122 1.1.4.2 tls { 123 1.1.4.2 tls const uint64_t daif = reg_daif_read(); 124 1.1.4.2 tls /* 125 1.1.4.2 tls * Use the address translation instruction to do the lookup. 126 1.1.4.2 tls */ 127 1.1.4.2 tls reg_daifset_write(DAIF_I|DAIF_F); 128 1.1.4.2 tls __asm __volatile("at\ts1e1r, %0" :: "r"(va)); 129 1.1.4.2 tls paddr_t pa = reg_par_el1_read(); 130 1.1.4.2 tls pa = (pa & PAR_F) ? VTOPHYS_FAILED : (pa & PAR_PA); 131 1.1.4.2 tls reg_daif_write(daif); 132 1.1.4.2 tls return pa; 133 1.1.4.2 tls } 134 1.1.4.2 tls 135 1.1.4.2 tls static inline paddr_t 136 1.1.4.2 tls vtophysw(vaddr_t va) 137 1.1.4.2 tls { 138 1.1.4.2 tls const uint64_t daif = reg_daif_read(); 139 1.1.4.2 tls /* 140 1.1.4.2 tls * Use the address translation instruction to do the lookup. 141 1.1.4.2 tls */ 142 1.1.4.2 tls reg_daifset_write(DAIF_I|DAIF_F); 143 1.1.4.2 tls __asm __volatile("at\ts1e1w, %0" :: "r"(va)); 144 1.1.4.2 tls paddr_t pa = reg_par_el1_read(); 145 1.1.4.2 tls pa = (pa & PAR_F) ? VTOPHYS_FAILED : (pa & PAR_PA); 146 1.1.4.2 tls reg_daif_write(daif); 147 1.1.4.2 tls return pa; 148 1.1.4.2 tls } 149 1.1.4.2 tls 150 1.1.4.2 tls #elif defined(__arm__) 151 1.1.4.2 tls 152 1.1.4.2 tls #include <arm/locore.h> 153 1.1.4.2 tls 154 1.1.4.2 tls #endif /* __aarch64__/__arm__ */ 155 1.1.4.2 tls 156 1.1.4.2 tls #endif /* _AARCH64_LOCORE_H_ */ 157
Indexes created Thu Oct 30 16:09:53 GMT 2025