sys_io.h

Go to the documentation of this file.

/*
 * Copyright (c) 2015, Wind River Systems, Inc.
 * Copyright (c) 2017, Oticon A/S
 *
 * SPDX-License-Identifier: Apache-2.0
 */
 
/* "Arch" bit manipulation functions in non-arch-specific C code (uses some
 * gcc builtins)
 */
 
#ifndef ZEPHYR_INCLUDE_ARCH_ARM64_SYS_IO_H_
#define ZEPHYR_INCLUDE_ARCH_ARM64_SYS_IO_H_
 
#ifndef _ASMLANGUAGE
 
#include <zephyr/types.h>
#include <sys/sys_io.h>
 
#ifdef __cplusplus
extern "C" {
#endif
 
/* Memory mapped registers I/O functions */
 
/*
 * We need to use explicit assembler instruction there, because with classic
 * "volatile pointer" approach compiler might generate instruction with
 * immediate value like
 *
 * str     w4, [x1], #4
 *
 * Such instructions produce invalid syndrome in HSR register, so hypervisor
 * can't emulate MMIO  when it traps memory access.
 */
static ALWAYS_INLINE uint8_t sys_read8(mem_addr_t addr)
{
        uint8_t val;
 
        __asm__ volatile("ldrb %w0, [%1]" : "=r" (val) : "r" (addr));
 
        __DMB();
        return val;
}
 
static ALWAYS_INLINE void sys_write8(uint8_t data, mem_addr_t addr)
{
        __DMB();
        __asm__ volatile("strb %w0, [%1]" : : "r" (data), "r" (addr));
}
 
static ALWAYS_INLINE uint16_t sys_read16(mem_addr_t addr)
{
        uint16_t val;
 
        __asm__ volatile("ldrh %w0, [%1]" : "=r" (val) : "r" (addr));
 
        __DMB();
        return val;
}
 
static ALWAYS_INLINE void sys_write16(uint16_t data, mem_addr_t addr)
{
        __DMB();
        __asm__ volatile("strh %w0, [%1]" : : "r" (data), "r" (addr));
}
 
static ALWAYS_INLINE uint32_t sys_read32(mem_addr_t addr)
{
        uint32_t val;
 
        __asm__ volatile("ldr %w0, [%1]" : "=r" (val) : "r" (addr));
 
        __DMB();
        return val;
}
 
static ALWAYS_INLINE void sys_write32(uint32_t data, mem_addr_t addr)
{
        __DMB();
        __asm__ volatile("str %w0, [%1]" : : "r" (data), "r" (addr));
}
 
static ALWAYS_INLINE uint64_t sys_read64(mem_addr_t addr)
{
        uint64_t val;
 
        __asm__ volatile("ldr %x0, [%1]" : "=r" (val) : "r" (addr));
 
        __DMB();
        return val;
}
 
static ALWAYS_INLINE void sys_write64(uint64_t data, mem_addr_t addr)
{
        __DMB();
        __asm__ volatile("str %x0, [%1]" : : "r" (data), "r" (addr));
}
 
#ifdef __cplusplus
}
#endif
 
#endif /* _ASMLANGUAGE */
 
#endif /* ZEPHYR_INCLUDE_ARCH_ARM64_SYS_IO_H_ */