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 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 | /* * Copyright (c) 2016 Jean-Paul Etienne <fractalclone@gmail.com> * * SPDX-License-Identifier: Apache-2.0 */ /** * @brief RISCV32 memory mapped register I/O operations */ #ifndef _RISCV32_SYS_IO_H_ #define _RISCV32_SYS_IO_H_ #if !defined(_ASMLANGUAGE) #include <sys_io.h> /* Memory mapped registers I/O functions */ static inline u32_t sys_read32(mem_addr_t addr) { return *(volatile u32_t *)addr; } static inline void sys_write32(u32_t data, mem_addr_t addr) { *(volatile u32_t *)addr = data; } static inline u8_t sys_read8(mem_addr_t addr) { return *(volatile u8_t *)addr; } static inline void sys_write8(u8_t data, mem_addr_t addr) { *(volatile u8_t *)addr = data; } /* Memory bit manipulation functions */ static inline void sys_set_bit(mem_addr_t addr, unsigned int bit) { u32_t temp = *(volatile u32_t *)addr; *(volatile u32_t *)addr = temp | (1 << bit); } static inline void sys_clear_bit(mem_addr_t addr, unsigned int bit) { u32_t temp = *(volatile u32_t *)addr; *(volatile u32_t *)addr = temp & ~(1 << bit); } static ALWAYS_INLINE int sys_test_bit(mem_addr_t addr, unsigned int bit) { u32_t temp = *(volatile u32_t *)addr; return temp & (1 << bit); } 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 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_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; } #endif /* !_ASMLANGUAGE */ #endif /* _RISCV32_SYS_IO_H_ */ |