ebe51e26cb
As of today 'include/arch/common/sys_io.h" has generic implementation for MMIO accessors and memory bits manipulation functions. That leads to several architectures like ARC, ARM/aarch64, ARM/aarch32/corter_a_r redefine entire 'common/sys_io.h' even if they only have different MMIO accessors implementation. So split 'include/arch/common/sys_io.h" to * sys_io.h - generic MMIO accessors * sys_bitops.h - generic memory bits manipulation functions Signed-off-by: Eugeniy Paltsev <Eugeniy.Paltsev@synopsys.com>
117 lines
2.3 KiB
C
117 lines
2.3 KiB
C
/*
|
|
* 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_ */
|