/*
 * Copyright (C) 2014 Stefan Kristiansson <stefan.kristiansson@saunalahti.fi>
 *
 * This file is licensed under the terms of the GNU General Public License
 * version 2.  This program is licensed "as is" without any warranty of any
 * kind, whether express or implied.
 */

#ifndef __ASM_OPENRISC_BITOPS_ATOMIC_H
#define __ASM_OPENRISC_BITOPS_ATOMIC_H

static inline void set_bit(int nr, volatile unsigned long *addr)
{
        unsigned long mask = BIT_MASK(nr);
        unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
        unsigned long tmp;

        __asm__ __volatile__(
                "1:     l.lwa   %0,0(%1)        \n"
                "       l.or    %0,%0,%2        \n"
                "       l.swa   0(%1),%0        \n"
                "       l.bnf   1b              \n"
                "        l.nop                  \n"
                : "=&r"(tmp)
                : "r"(p), "r"(mask)
                : "cc", "memory");
}

static inline void clear_bit(int nr, volatile unsigned long *addr)
{
        unsigned long mask = BIT_MASK(nr);
        unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
        unsigned long tmp;

        __asm__ __volatile__(
                "1:     l.lwa   %0,0(%1)        \n"
                "       l.and   %0,%0,%2        \n"
                "       l.swa   0(%1),%0        \n"
                "       l.bnf   1b              \n"
                "        l.nop                  \n"
                : "=&r"(tmp)
                : "r"(p), "r"(~mask)
                : "cc", "memory");
}

static inline void change_bit(int nr, volatile unsigned long *addr)
{
        unsigned long mask = BIT_MASK(nr);
        unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
        unsigned long tmp;

        __asm__ __volatile__(
                "1:     l.lwa   %0,0(%1)        \n"
                "       l.xor   %0,%0,%2        \n"
                "       l.swa   0(%1),%0        \n"
                "       l.bnf   1b              \n"
                "        l.nop                  \n"
                : "=&r"(tmp)
                : "r"(p), "r"(mask)
                : "cc", "memory");
}

static inline int test_and_set_bit(int nr, volatile unsigned long *addr)
{
        unsigned long mask = BIT_MASK(nr);
        unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
        unsigned long old;
        unsigned long tmp;

        __asm__ __volatile__(
                "1:     l.lwa   %0,0(%2)        \n"
                "       l.or    %1,%0,%3        \n"
                "       l.swa   0(%2),%1        \n"
                "       l.bnf   1b              \n"
                "        l.nop                  \n"
                : "=&r"(old), "=&r"(tmp)
                : "r"(p), "r"(mask)
                : "cc", "memory");

        return (old & mask) != 0;
}

static inline int test_and_clear_bit(int nr, volatile unsigned long *addr)
{
        unsigned long mask = BIT_MASK(nr);
        unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
        unsigned long old;
        unsigned long tmp;

        __asm__ __volatile__(
                "1:     l.lwa   %0,0(%2)        \n"
                "       l.and   %1,%0,%3        \n"
                "       l.swa   0(%2),%1        \n"
                "       l.bnf   1b              \n"
                "        l.nop                  \n"
                : "=&r"(old), "=&r"(tmp)
                : "r"(p), "r"(~mask)
                : "cc", "memory");

        return (old & mask) != 0;
}

static inline int test_and_change_bit(int nr, volatile unsigned long *addr)
{
        unsigned long mask = BIT_MASK(nr);
        unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr);
        unsigned long old;
        unsigned long tmp;

        __asm__ __volatile__(
                "1:     l.lwa   %0,0(%2)        \n"
                "       l.xor   %1,%0,%3        \n"
                "       l.swa   0(%2),%1        \n"
                "       l.bnf   1b              \n"
                "        l.nop                  \n"
                : "=&r"(old), "=&r"(tmp)
                : "r"(p), "r"(mask)
                : "cc", "memory");

        return (old & mask) != 0;
}

#endif /* __ASM_OPENRISC_BITOPS_ATOMIC_H */