/* SPDX-License-Identifier: GPL-2.0-only */

#ifndef ASM__RISCV__SYSTEM_H
#define ASM__RISCV__SYSTEM_H

#include <xen/stdbool.h>

#include <asm/csr.h>

#ifndef __ASSEMBLER__

#define RISCV_FENCE(p, s) \
    __asm__ __volatile__ ( "fence " #p "," #s : : : "memory" )

/* These barriers need to enforce ordering on both devices or memory. */
#define mb()                    RISCV_FENCE(iorw, iorw)
#define rmb()                   RISCV_FENCE(ir, ir)
#define wmb()                   RISCV_FENCE(ow, ow)

/* These barriers do not need to enforce ordering on devices, just memory. */
#define smp_mb()                RISCV_FENCE(rw, rw)
#define smp_rmb()               RISCV_FENCE(r, r)
#define smp_wmb()               RISCV_FENCE(w, w)
#define smp_mb__before_atomic() smp_mb()
#define smp_mb__after_atomic()  smp_mb()

/*
#define smp_store_release(p, v)         \
do {                                    \
    compiletime_assert_atomic_type(*p); \
    RISCV_FENCE(rw, w);                 \
    WRITE_ONCE(*p, v);                  \
} while (0)

#define smp_load_acquire(p)             \
({                                      \
    typeof(*p) p1 = READ_ONCE(*p);      \
    compiletime_assert_atomic_type(*p); \
    RISCV_FENCE(r,rw);                  \
    p1;                                 \
})
*/

static inline unsigned long local_save_flags(void)
{
    return csr_read(sstatus);
}

static inline void local_irq_enable(void)
{
    csr_set(sstatus, SSTATUS_SIE);
}

static inline void local_irq_disable(void)
{
    csr_clear(sstatus, SSTATUS_SIE);
}

#define local_irq_save(x)                           \
({                                                  \
    x = csr_read_clear(CSR_SSTATUS, SSTATUS_SIE);   \
    local_irq_disable();                            \
})

static inline void local_irq_restore(unsigned long flags)
{
	csr_set(CSR_SSTATUS, flags & SSTATUS_SIE);
}

static inline bool local_irq_is_enabled(void)
{
    unsigned long flags = local_save_flags();

    return (flags & SSTATUS_SIE) != 0;
}

#define arch_fetch_and_add(x, v) __sync_fetch_and_add(x, v)

#endif /* __ASSEMBLER__ */

#endif /* ASM__RISCV__SYSTEM_H */

/*
 * Local variables:
 * mode: C
 * c-file-style: "BSD"
 * c-basic-offset: 4
 * indent-tabs-mode: nil
 * End:
 */
