Home | History | Annotate | Line # | Download | only in include
locore.h revision 1.8
      1 /* $NetBSD: locore.h,v 1.8 2021/02/20 19:27:35 jmcneill Exp $ */
      2 
      3 /*-
      4  * Copyright (c) 2014 The NetBSD Foundation, Inc.
      5  * All rights reserved.
      6  *
      7  * This code is derived from software contributed to The NetBSD Foundation
      8  * by Matt Thomas of 3am Software Foundry.
      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  *
     19  * THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
     20  * ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
     21  * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
     22  * PURPOSE ARE DISCLAIMED.  IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
     23  * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
     24  * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
     25  * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
     26  * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
     27  * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
     28  * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
     29  * POSSIBILITY OF SUCH DAMAGE.
     30  */
     31 
     32 #ifndef _AARCH64_LOCORE_H_
     33 #define _AARCH64_LOCORE_H_
     34 
     35 #ifdef __aarch64__
     36 
     37 #ifdef _KERNEL_OPT
     38 #include "opt_multiprocessor.h"
     39 #endif
     40 
     41 #ifdef _LOCORE
     42 
     43 #define ENABLE_INTERRUPT	\
     44 	msr daifclr, #((DAIF_I|DAIF_F) >> DAIF_SETCLR_SHIFT)
     45 #define DISABLE_INTERRUPT	\
     46 	msr daifset, #((DAIF_I|DAIF_F) >> DAIF_SETCLR_SHIFT)
     47 
     48 #else /* _LOCORE */
     49 
     50 #include <sys/types.h>
     51 
     52 #include <aarch64/armreg.h>
     53 #include <aarch64/machdep.h>	/* arm32 compat */
     54 
     55 /* for compatibility arch/arm */
     56 #define I32_bit			DAIF_I
     57 #define F32_bit			DAIF_F
     58 #define cpsie(psw)		daif_enable((psw))
     59 #define cpsid(psw)		daif_disable((psw))
     60 
     61 
     62 #define ENABLE_INTERRUPT()	\
     63 	reg_daifclr_write((DAIF_I|DAIF_F) >> DAIF_SETCLR_SHIFT)
     64 #define DISABLE_INTERRUPT()	\
     65 	reg_daifset_write((DAIF_I|DAIF_F) >> DAIF_SETCLR_SHIFT)
     66 
     67 #define DAIF_MASK		(DAIF_D|DAIF_A|DAIF_I|DAIF_F)
     68 
     69 static inline void __unused
     70 daif_enable(register_t psw)
     71 {
     72 	if (!__builtin_constant_p(psw)) {
     73 		reg_daif_write(reg_daif_read() & ~psw);
     74 	} else {
     75 		reg_daifclr_write((psw & DAIF_MASK) >> DAIF_SETCLR_SHIFT);
     76 	}
     77 }
     78 
     79 static inline register_t __unused
     80 daif_disable(register_t psw)
     81 {
     82 	register_t oldpsw = reg_daif_read();
     83 	if ((oldpsw & psw) != psw) {
     84 		if (!__builtin_constant_p(psw)) {
     85 			reg_daif_write(oldpsw | psw);
     86 		} else {
     87 			reg_daifset_write((psw & DAIF_MASK) >> DAIF_SETCLR_SHIFT);
     88 		}
     89 	}
     90 	return oldpsw;
     91 }
     92 
     93 #endif /* _LOCORE */
     94 
     95 #elif defined(__arm__)
     96 
     97 #include <arm/locore.h>
     98 
     99 #endif /* __aarch64__/__arm__ */
    100 
    101 #endif /* _AARCH64_LOCORE_H_ */
    102