| #ifndef __ASM_SH_BITOPS_GRB_H | |
| #define __ASM_SH_BITOPS_GRB_H | |
| static inline void set_bit(int nr, volatile void * addr) | |
| { | |
| int mask; | |
| volatile unsigned int *a = addr; | |
| unsigned long tmp; | |
| a += nr >> 5; | |
| mask = 1 << (nr & 0x1f); | |
| __asm__ __volatile__ ( | |
| " .align 2 \n\t" | |
| " mova 1f, r0 \n\t" /* r0 = end point */ | |
| " mov r15, r1 \n\t" /* r1 = saved sp */ | |
| " mov #-6, r15 \n\t" /* LOGIN: r15 = size */ | |
| " mov.l @%1, %0 \n\t" /* load old value */ | |
| " or %2, %0 \n\t" /* or */ | |
| " mov.l %0, @%1 \n\t" /* store new value */ | |
| "1: mov r1, r15 \n\t" /* LOGOUT */ | |
| : "=&r" (tmp), | |
| "+r" (a) | |
| : "r" (mask) | |
| : "memory" , "r0", "r1"); | |
| } | |
| static inline void clear_bit(int nr, volatile void * addr) | |
| { | |
| int mask; | |
| volatile unsigned int *a = addr; | |
| unsigned long tmp; | |
| a += nr >> 5; | |
| mask = ~(1 << (nr & 0x1f)); | |
| __asm__ __volatile__ ( | |
| " .align 2 \n\t" | |
| " mova 1f, r0 \n\t" /* r0 = end point */ | |
| " mov r15, r1 \n\t" /* r1 = saved sp */ | |
| " mov #-6, r15 \n\t" /* LOGIN: r15 = size */ | |
| " mov.l @%1, %0 \n\t" /* load old value */ | |
| " and %2, %0 \n\t" /* and */ | |
| " mov.l %0, @%1 \n\t" /* store new value */ | |
| "1: mov r1, r15 \n\t" /* LOGOUT */ | |
| : "=&r" (tmp), | |
| "+r" (a) | |
| : "r" (mask) | |
| : "memory" , "r0", "r1"); | |
| } | |
| static inline void change_bit(int nr, volatile void * addr) | |
| { | |
| int mask; | |
| volatile unsigned int *a = addr; | |
| unsigned long tmp; | |
| a += nr >> 5; | |
| mask = 1 << (nr & 0x1f); | |
| __asm__ __volatile__ ( | |
| " .align 2 \n\t" | |
| " mova 1f, r0 \n\t" /* r0 = end point */ | |
| " mov r15, r1 \n\t" /* r1 = saved sp */ | |
| " mov #-6, r15 \n\t" /* LOGIN: r15 = size */ | |
| " mov.l @%1, %0 \n\t" /* load old value */ | |
| " xor %2, %0 \n\t" /* xor */ | |
| " mov.l %0, @%1 \n\t" /* store new value */ | |
| "1: mov r1, r15 \n\t" /* LOGOUT */ | |
| : "=&r" (tmp), | |
| "+r" (a) | |
| : "r" (mask) | |
| : "memory" , "r0", "r1"); | |
| } | |
| static inline int test_and_set_bit(int nr, volatile void * addr) | |
| { | |
| int mask, retval; | |
| volatile unsigned int *a = addr; | |
| unsigned long tmp; | |
| a += nr >> 5; | |
| mask = 1 << (nr & 0x1f); | |
| __asm__ __volatile__ ( | |
| " .align 2 \n\t" | |
| " mova 1f, r0 \n\t" /* r0 = end point */ | |
| " mov r15, r1 \n\t" /* r1 = saved sp */ | |
| " mov #-14, r15 \n\t" /* LOGIN: r15 = size */ | |
| " mov.l @%2, %0 \n\t" /* load old value */ | |
| " mov %0, %1 \n\t" | |
| " tst %1, %3 \n\t" /* T = ((*a & mask) == 0) */ | |
| " mov #-1, %1 \n\t" /* retvat = -1 */ | |
| " negc %1, %1 \n\t" /* retval = (mask & *a) != 0 */ | |
| " or %3, %0 \n\t" | |
| " mov.l %0, @%2 \n\t" /* store new value */ | |
| "1: mov r1, r15 \n\t" /* LOGOUT */ | |
| : "=&r" (tmp), | |
| "=&r" (retval), | |
| "+r" (a) | |
| : "r" (mask) | |
| : "memory" , "r0", "r1" ,"t"); | |
| return retval; | |
| } | |
| static inline int test_and_clear_bit(int nr, volatile void * addr) | |
| { | |
| int mask, retval,not_mask; | |
| volatile unsigned int *a = addr; | |
| unsigned long tmp; | |
| a += nr >> 5; | |
| mask = 1 << (nr & 0x1f); | |
| not_mask = ~mask; | |
| __asm__ __volatile__ ( | |
| " .align 2 \n\t" | |
| " mova 1f, r0 \n\t" /* r0 = end point */ | |
| " mov r15, r1 \n\t" /* r1 = saved sp */ | |
| " mov #-14, r15 \n\t" /* LOGIN */ | |
| " mov.l @%2, %0 \n\t" /* load old value */ | |
| " mov %0, %1 \n\t" /* %1 = *a */ | |
| " tst %1, %3 \n\t" /* T = ((*a & mask) == 0) */ | |
| " mov #-1, %1 \n\t" /* retvat = -1 */ | |
| " negc %1, %1 \n\t" /* retval = (mask & *a) != 0 */ | |
| " and %4, %0 \n\t" | |
| " mov.l %0, @%2 \n\t" /* store new value */ | |
| "1: mov r1, r15 \n\t" /* LOGOUT */ | |
| : "=&r" (tmp), | |
| "=&r" (retval), | |
| "+r" (a) | |
| : "r" (mask), | |
| "r" (not_mask) | |
| : "memory" , "r0", "r1", "t"); | |
| return retval; | |
| } | |
| static inline int test_and_change_bit(int nr, volatile void * addr) | |
| { | |
| int mask, retval; | |
| volatile unsigned int *a = addr; | |
| unsigned long tmp; | |
| a += nr >> 5; | |
| mask = 1 << (nr & 0x1f); | |
| __asm__ __volatile__ ( | |
| " .align 2 \n\t" | |
| " mova 1f, r0 \n\t" /* r0 = end point */ | |
| " mov r15, r1 \n\t" /* r1 = saved sp */ | |
| " mov #-14, r15 \n\t" /* LOGIN */ | |
| " mov.l @%2, %0 \n\t" /* load old value */ | |
| " mov %0, %1 \n\t" /* %1 = *a */ | |
| " tst %1, %3 \n\t" /* T = ((*a & mask) == 0) */ | |
| " mov #-1, %1 \n\t" /* retvat = -1 */ | |
| " negc %1, %1 \n\t" /* retval = (mask & *a) != 0 */ | |
| " xor %3, %0 \n\t" | |
| " mov.l %0, @%2 \n\t" /* store new value */ | |
| "1: mov r1, r15 \n\t" /* LOGOUT */ | |
| : "=&r" (tmp), | |
| "=&r" (retval), | |
| "+r" (a) | |
| : "r" (mask) | |
| : "memory" , "r0", "r1", "t"); | |
| return retval; | |
| } | |
| #endif /* __ASM_SH_BITOPS_GRB_H */ |