Home | History | Annotate | Line # | Download | only in include 
      1 /* $NetBSD: locore.h,v 1.9 2021/03/01 11:29:14 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 #define ENABLE_INTERRUPT()						\
     62 	reg_daifclr_write((DAIF_I|DAIF_F) >> DAIF_SETCLR_SHIFT)
     63 #define DISABLE_INTERRUPT()						\
     64 	reg_daifset_write((DAIF_I|DAIF_F) >> DAIF_SETCLR_SHIFT)
     65 #define DISABLE_INTERRUPT_SAVE()					\
     66 	daif_disable(DAIF_I|DAIF_F)
     67 
     68 #define DAIF_MASK		(DAIF_D|DAIF_A|DAIF_I|DAIF_F)
     69 
     70 static inline void __unused
     71 daif_enable(register_t psw)
     72 {
     73 	if (!__builtin_constant_p(psw)) {
     74 		reg_daif_write(reg_daif_read() & ~psw);
     75 	} else {
     76 		reg_daifclr_write((psw & DAIF_MASK) >> DAIF_SETCLR_SHIFT);
     77 	}
     78 }
     79 
     80 static inline register_t __unused
     81 daif_disable(register_t psw)
     82 {
     83 	register_t oldpsw = reg_daif_read();
     84 	if ((oldpsw & psw) != psw) {
     85 		if (!__builtin_constant_p(psw)) {
     86 			reg_daif_write(oldpsw | psw);
     87 		} else {
     88 			reg_daifset_write((psw & DAIF_MASK) >> DAIF_SETCLR_SHIFT);
     89 		}
     90 	}
     91 	return oldpsw;
     92 }
     93 
     94 #endif /* _LOCORE */
     95 
     96 #elif defined(__arm__)
     97 
     98 #include <arm/locore.h>
     99 
    100 #endif /* __aarch64__/__arm__ */
    101 
    102 #endif /* _AARCH64_LOCORE_H_ */
    103