18c2ecf20Sopenharmony_ci/* 28c2ecf20Sopenharmony_ci * Copyright (C) 2014 Stefan Kristiansson <stefan.kristiansson@saunalahti.fi> 38c2ecf20Sopenharmony_ci * 48c2ecf20Sopenharmony_ci * This file is licensed under the terms of the GNU General Public License 58c2ecf20Sopenharmony_ci * version 2. This program is licensed "as is" without any warranty of any 68c2ecf20Sopenharmony_ci * kind, whether express or implied. 78c2ecf20Sopenharmony_ci */ 88c2ecf20Sopenharmony_ci 98c2ecf20Sopenharmony_ci#ifndef __ASM_OPENRISC_BITOPS_ATOMIC_H 108c2ecf20Sopenharmony_ci#define __ASM_OPENRISC_BITOPS_ATOMIC_H 118c2ecf20Sopenharmony_ci 128c2ecf20Sopenharmony_cistatic inline void set_bit(int nr, volatile unsigned long *addr) 138c2ecf20Sopenharmony_ci{ 148c2ecf20Sopenharmony_ci unsigned long mask = BIT_MASK(nr); 158c2ecf20Sopenharmony_ci unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr); 168c2ecf20Sopenharmony_ci unsigned long tmp; 178c2ecf20Sopenharmony_ci 188c2ecf20Sopenharmony_ci __asm__ __volatile__( 198c2ecf20Sopenharmony_ci "1: l.lwa %0,0(%1) \n" 208c2ecf20Sopenharmony_ci " l.or %0,%0,%2 \n" 218c2ecf20Sopenharmony_ci " l.swa 0(%1),%0 \n" 228c2ecf20Sopenharmony_ci " l.bnf 1b \n" 238c2ecf20Sopenharmony_ci " l.nop \n" 248c2ecf20Sopenharmony_ci : "=&r"(tmp) 258c2ecf20Sopenharmony_ci : "r"(p), "r"(mask) 268c2ecf20Sopenharmony_ci : "cc", "memory"); 278c2ecf20Sopenharmony_ci} 288c2ecf20Sopenharmony_ci 298c2ecf20Sopenharmony_cistatic inline void clear_bit(int nr, volatile unsigned long *addr) 308c2ecf20Sopenharmony_ci{ 318c2ecf20Sopenharmony_ci unsigned long mask = BIT_MASK(nr); 328c2ecf20Sopenharmony_ci unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr); 338c2ecf20Sopenharmony_ci unsigned long tmp; 348c2ecf20Sopenharmony_ci 358c2ecf20Sopenharmony_ci __asm__ __volatile__( 368c2ecf20Sopenharmony_ci "1: l.lwa %0,0(%1) \n" 378c2ecf20Sopenharmony_ci " l.and %0,%0,%2 \n" 388c2ecf20Sopenharmony_ci " l.swa 0(%1),%0 \n" 398c2ecf20Sopenharmony_ci " l.bnf 1b \n" 408c2ecf20Sopenharmony_ci " l.nop \n" 418c2ecf20Sopenharmony_ci : "=&r"(tmp) 428c2ecf20Sopenharmony_ci : "r"(p), "r"(~mask) 438c2ecf20Sopenharmony_ci : "cc", "memory"); 448c2ecf20Sopenharmony_ci} 458c2ecf20Sopenharmony_ci 468c2ecf20Sopenharmony_cistatic inline void change_bit(int nr, volatile unsigned long *addr) 478c2ecf20Sopenharmony_ci{ 488c2ecf20Sopenharmony_ci unsigned long mask = BIT_MASK(nr); 498c2ecf20Sopenharmony_ci unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr); 508c2ecf20Sopenharmony_ci unsigned long tmp; 518c2ecf20Sopenharmony_ci 528c2ecf20Sopenharmony_ci __asm__ __volatile__( 538c2ecf20Sopenharmony_ci "1: l.lwa %0,0(%1) \n" 548c2ecf20Sopenharmony_ci " l.xor %0,%0,%2 \n" 558c2ecf20Sopenharmony_ci " l.swa 0(%1),%0 \n" 568c2ecf20Sopenharmony_ci " l.bnf 1b \n" 578c2ecf20Sopenharmony_ci " l.nop \n" 588c2ecf20Sopenharmony_ci : "=&r"(tmp) 598c2ecf20Sopenharmony_ci : "r"(p), "r"(mask) 608c2ecf20Sopenharmony_ci : "cc", "memory"); 618c2ecf20Sopenharmony_ci} 628c2ecf20Sopenharmony_ci 638c2ecf20Sopenharmony_cistatic inline int test_and_set_bit(int nr, volatile unsigned long *addr) 648c2ecf20Sopenharmony_ci{ 658c2ecf20Sopenharmony_ci unsigned long mask = BIT_MASK(nr); 668c2ecf20Sopenharmony_ci unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr); 678c2ecf20Sopenharmony_ci unsigned long old; 688c2ecf20Sopenharmony_ci unsigned long tmp; 698c2ecf20Sopenharmony_ci 708c2ecf20Sopenharmony_ci __asm__ __volatile__( 718c2ecf20Sopenharmony_ci "1: l.lwa %0,0(%2) \n" 728c2ecf20Sopenharmony_ci " l.or %1,%0,%3 \n" 738c2ecf20Sopenharmony_ci " l.swa 0(%2),%1 \n" 748c2ecf20Sopenharmony_ci " l.bnf 1b \n" 758c2ecf20Sopenharmony_ci " l.nop \n" 768c2ecf20Sopenharmony_ci : "=&r"(old), "=&r"(tmp) 778c2ecf20Sopenharmony_ci : "r"(p), "r"(mask) 788c2ecf20Sopenharmony_ci : "cc", "memory"); 798c2ecf20Sopenharmony_ci 808c2ecf20Sopenharmony_ci return (old & mask) != 0; 818c2ecf20Sopenharmony_ci} 828c2ecf20Sopenharmony_ci 838c2ecf20Sopenharmony_cistatic inline int test_and_clear_bit(int nr, volatile unsigned long *addr) 848c2ecf20Sopenharmony_ci{ 858c2ecf20Sopenharmony_ci unsigned long mask = BIT_MASK(nr); 868c2ecf20Sopenharmony_ci unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr); 878c2ecf20Sopenharmony_ci unsigned long old; 888c2ecf20Sopenharmony_ci unsigned long tmp; 898c2ecf20Sopenharmony_ci 908c2ecf20Sopenharmony_ci __asm__ __volatile__( 918c2ecf20Sopenharmony_ci "1: l.lwa %0,0(%2) \n" 928c2ecf20Sopenharmony_ci " l.and %1,%0,%3 \n" 938c2ecf20Sopenharmony_ci " l.swa 0(%2),%1 \n" 948c2ecf20Sopenharmony_ci " l.bnf 1b \n" 958c2ecf20Sopenharmony_ci " l.nop \n" 968c2ecf20Sopenharmony_ci : "=&r"(old), "=&r"(tmp) 978c2ecf20Sopenharmony_ci : "r"(p), "r"(~mask) 988c2ecf20Sopenharmony_ci : "cc", "memory"); 998c2ecf20Sopenharmony_ci 1008c2ecf20Sopenharmony_ci return (old & mask) != 0; 1018c2ecf20Sopenharmony_ci} 1028c2ecf20Sopenharmony_ci 1038c2ecf20Sopenharmony_cistatic inline int test_and_change_bit(int nr, volatile unsigned long *addr) 1048c2ecf20Sopenharmony_ci{ 1058c2ecf20Sopenharmony_ci unsigned long mask = BIT_MASK(nr); 1068c2ecf20Sopenharmony_ci unsigned long *p = ((unsigned long *)addr) + BIT_WORD(nr); 1078c2ecf20Sopenharmony_ci unsigned long old; 1088c2ecf20Sopenharmony_ci unsigned long tmp; 1098c2ecf20Sopenharmony_ci 1108c2ecf20Sopenharmony_ci __asm__ __volatile__( 1118c2ecf20Sopenharmony_ci "1: l.lwa %0,0(%2) \n" 1128c2ecf20Sopenharmony_ci " l.xor %1,%0,%3 \n" 1138c2ecf20Sopenharmony_ci " l.swa 0(%2),%1 \n" 1148c2ecf20Sopenharmony_ci " l.bnf 1b \n" 1158c2ecf20Sopenharmony_ci " l.nop \n" 1168c2ecf20Sopenharmony_ci : "=&r"(old), "=&r"(tmp) 1178c2ecf20Sopenharmony_ci : "r"(p), "r"(mask) 1188c2ecf20Sopenharmony_ci : "cc", "memory"); 1198c2ecf20Sopenharmony_ci 1208c2ecf20Sopenharmony_ci return (old & mask) != 0; 1218c2ecf20Sopenharmony_ci} 1228c2ecf20Sopenharmony_ci 1238c2ecf20Sopenharmony_ci#endif /* __ASM_OPENRISC_BITOPS_ATOMIC_H */ 124