Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 | /* * Copyright (c) 2020, Wind River Systems, Inc. * Copyright (c) 2017, Oticon A/S * Copyright (c) 2020, Synopsys * * SPDX-License-Identifier: Apache-2.0 */ /* Memory bits manipulation functions in non-arch-specific C code */ #ifndef ZEPHYR_INCLUDE_ARCH_COMMON_SYS_BITOPS_H_ #define ZEPHYR_INCLUDE_ARCH_COMMON_SYS_BITOPS_H_ #ifndef _ASMLANGUAGE #include <toolchain.h> #include <zephyr/types.h> #include <sys/sys_io.h> #ifdef __cplusplus extern "C" { #endif static ALWAYS_INLINE void sys_set_bit(mem_addr_t addr, unsigned int bit) { uint32_t temp = *(volatile uint32_t *)addr; *(volatile uint32_t *)addr = temp | (1 << bit); } static ALWAYS_INLINE void sys_clear_bit(mem_addr_t addr, unsigned int bit) { uint32_t temp = *(volatile uint32_t *)addr; *(volatile uint32_t *)addr = temp & ~(1 << bit); } static ALWAYS_INLINE int sys_test_bit(mem_addr_t addr, unsigned int bit) { uint32_t temp = *(volatile uint32_t *)addr; return temp & (1 << bit); } static ALWAYS_INLINE void sys_bitfield_set_bit(mem_addr_t addr, unsigned int bit) { /* Doing memory offsets in terms of 32-bit values to prevent * alignment issues */ sys_set_bit(addr + ((bit >> 5) << 2), bit & 0x1F); } static ALWAYS_INLINE void sys_bitfield_clear_bit(mem_addr_t addr, unsigned int bit) { sys_clear_bit(addr + ((bit >> 5) << 2), bit & 0x1F); } static ALWAYS_INLINE int sys_bitfield_test_bit(mem_addr_t addr, unsigned int bit) { return sys_test_bit(addr + ((bit >> 5) << 2), bit & 0x1F); } static ALWAYS_INLINE int sys_test_and_set_bit(mem_addr_t addr, unsigned int bit) { int ret; ret = sys_test_bit(addr, bit); sys_set_bit(addr, bit); return ret; } static ALWAYS_INLINE int sys_test_and_clear_bit(mem_addr_t addr, unsigned int bit) { int ret; ret = sys_test_bit(addr, bit); sys_clear_bit(addr, bit); return ret; } static ALWAYS_INLINE int sys_bitfield_test_and_set_bit(mem_addr_t addr, unsigned int bit) { int ret; ret = sys_bitfield_test_bit(addr, bit); sys_bitfield_set_bit(addr, bit); return ret; } static ALWAYS_INLINE int sys_bitfield_test_and_clear_bit(mem_addr_t addr, unsigned int bit) { int ret; ret = sys_bitfield_test_bit(addr, bit); sys_bitfield_clear_bit(addr, bit); return ret; } #ifdef __cplusplus } #endif #endif /* _ASMLANGUAGE */ #endif /* ZEPHYR_INCLUDE_ARCH_COMMON_SYS_BITOPS_H_ */ |