include/asm-sparc/semaphore.h

   1 #ifndef _SPARC_SEMAPHORE_H
   2 #define _SPARC_SEMAPHORE_H
   3
   4 /* Dinky, good for nothing, just barely irq safe, Sparc semaphores. */
   5
   6 #ifdef __KERNEL__
   7
   8 #include <asm/atomic.h>
   9 #include <linux/wait.h>
  10 #include <linux/rwsem.h>
  11
  12 struct semaphore {
  13         atomic24_t count;
  14         int sleepers;
  15         wait_queue_head_t wait;
  16 #ifdef WAITQUEUE_DEBUG
  17         long __magic;
  18 #endif
  19 };
  20
  21 #ifdef WAITQUEUE_DEBUG
  22 # define __SEM_DEBUG_INIT(name) \
  23                 , (long)&(name).__magic
  24 #else
  25 # define __SEM_DEBUG_INIT(name)
  26 #endif
  27
  28 #define __SEMAPHORE_INITIALIZER(name,count) \
  29 { ATOMIC24_INIT(count), 0, __WAIT_QUEUE_HEAD_INITIALIZER((name).wait) \
  30         __SEM_DEBUG_INIT(name) }
  31
  32 #define __MUTEX_INITIALIZER(name) \
  33         __SEMAPHORE_INITIALIZER(name,1)
  34
  35 #define __DECLARE_SEMAPHORE_GENERIC(name,count) \
  36         struct semaphore name = __SEMAPHORE_INITIALIZER(name,count)
  37
  38 #define DECLARE_MUTEX(name) __DECLARE_SEMAPHORE_GENERIC(name,1)
  39 #define DECLARE_MUTEX_LOCKED(name) __DECLARE_SEMAPHORE_GENERIC(name,0)
  40
  41 static inline void sema_init (struct semaphore *sem, int val)
  42 {
  43         atomic24_set(&sem->count, val);
  44         sem->sleepers = 0;
  45         init_waitqueue_head(&sem->wait);
  46 #ifdef WAITQUEUE_DEBUG
  47         sem->__magic = (long)&sem->__magic;
  48 #endif
  49 }
  50
  51 static inline void init_MUTEX (struct semaphore *sem)
  52 {
  53         sema_init(sem, 1);
  54 }
  55
  56 static inline void init_MUTEX_LOCKED (struct semaphore *sem)
  57 {
  58         sema_init(sem, 0);
  59 }
  60
  61 extern void __down(struct semaphore * sem);
  62 extern int __down_interruptible(struct semaphore * sem);
  63 extern int __down_trylock(struct semaphore * sem);
  64 extern void __up(struct semaphore * sem);
  65
  66 static inline void down(struct semaphore * sem)
  67 {
  68         register volatile int *ptr asm("g1");
  69         register int increment asm("g2");
  70
  71 #ifdef WAITQUEUE_DEBUG
  72         CHECK_MAGIC(sem->__magic);
  73 #endif
  74         might_sleep();
  75
  76         ptr = &(sem->count.counter);
  77         increment = 1;
  78
  79         __asm__ __volatile__(
  80         "mov    %%o7, %%g4\n\t"
  81         "call   ___atomic24_sub\n\t"
  82         " add   %%o7, 8, %%o7\n\t"
  83         "tst    %%g2\n\t"
  84         "bl     2f\n\t"
  85         " nop\n"
  86         "1:\n\t"
  87         ".subsection 2\n"
  88         "2:\n\t"
  89         "save   %%sp, -64, %%sp\n\t"
  90         "mov    %%g1, %%l1\n\t"
  91         "mov    %%g5, %%l5\n\t"
  92         "call   %3\n\t"
  93         " mov   %%g1, %%o0\n\t"
  94         "mov    %%l1, %%g1\n\t"
  95         "ba     1b\n\t"
  96         " restore %%l5, %%g0, %%g5\n\t"
  97         ".previous\n"
  98         : "=&r" (increment)
  99         : "0" (increment), "r" (ptr), "i" (__down)
 100         : "g3", "g4", "g7", "memory", "cc");
 101 }
 102
 103 static inline int down_interruptible(struct semaphore * sem)
 104 {
 105         register volatile int *ptr asm("g1");
 106         register int increment asm("g2");
 107
 108 #ifdef WAITQUEUE_DEBUG
 109         CHECK_MAGIC(sem->__magic);
 110 #endif
 111         might_sleep();
 112
 113         ptr = &(sem->count.counter);
 114         increment = 1;
 115
 116         __asm__ __volatile__(
 117         "mov    %%o7, %%g4\n\t"
 118         "call   ___atomic24_sub\n\t"
 119         " add   %%o7, 8, %%o7\n\t"
 120         "tst    %%g2\n\t"
 121         "bl     2f\n\t"
 122         " clr   %%g2\n"
 123         "1:\n\t"
 124         ".subsection 2\n"
 125         "2:\n\t"
 126         "save   %%sp, -64, %%sp\n\t"
 127         "mov    %%g1, %%l1\n\t"
 128         "mov    %%g5, %%l5\n\t"
 129         "call   %3\n\t"
 130         " mov   %%g1, %%o0\n\t"
 131         "mov    %%l1, %%g1\n\t"
 132         "mov    %%l5, %%g5\n\t"
 133         "ba     1b\n\t"
 134         " restore %%o0, %%g0, %%g2\n\t"
 135         ".previous\n"
 136         : "=&r" (increment)
 137         : "0" (increment), "r" (ptr), "i" (__down_interruptible)
 138         : "g3", "g4", "g7", "memory", "cc");
 139
 140         return increment;
 141 }
 142
 143 static inline int down_trylock(struct semaphore * sem)
 144 {
 145         register volatile int *ptr asm("g1");
 146         register int increment asm("g2");
 147
 148 #ifdef WAITQUEUE_DEBUG
 149         CHECK_MAGIC(sem->__magic);
 150 #endif
 151
 152         ptr = &(sem->count.counter);
 153         increment = 1;
 154
 155         __asm__ __volatile__(
 156         "mov    %%o7, %%g4\n\t"
 157         "call   ___atomic24_sub\n\t"
 158         " add   %%o7, 8, %%o7\n\t"
 159         "tst    %%g2\n\t"
 160         "bl     2f\n\t"
 161         " clr   %%g2\n"
 162         "1:\n\t"
 163         ".subsection 2\n"
 164         "2:\n\t"
 165         "save   %%sp, -64, %%sp\n\t"
 166         "mov    %%g1, %%l1\n\t"
 167         "mov    %%g5, %%l5\n\t"
 168         "call   %3\n\t"
 169         " mov   %%g1, %%o0\n\t"
 170         "mov    %%l1, %%g1\n\t"
 171         "mov    %%l5, %%g5\n\t"
 172         "ba     1b\n\t"
 173         " restore %%o0, %%g0, %%g2\n\t"
 174         ".previous\n"
 175         : "=&r" (increment)
 176         : "0" (increment), "r" (ptr), "i" (__down_trylock)
 177         : "g3", "g4", "g7", "memory", "cc");
 178
 179         return increment;
 180 }
 181
 182 static inline void up(struct semaphore * sem)
 183 {
 184         register volatile int *ptr asm("g1");
 185         register int increment asm("g2");
 186
 187 #ifdef WAITQUEUE_DEBUG
 188         CHECK_MAGIC(sem->__magic);
 189 #endif
 190
 191         ptr = &(sem->count.counter);
 192         increment = 1;
 193
 194         __asm__ __volatile__(
 195         "mov    %%o7, %%g4\n\t"
 196         "call   ___atomic24_add\n\t"
 197         " add   %%o7, 8, %%o7\n\t"
 198         "tst    %%g2\n\t"
 199         "ble    2f\n\t"
 200         " nop\n"
 201         "1:\n\t"
 202         ".subsection 2\n"
 203         "2:\n\t"
 204         "save   %%sp, -64, %%sp\n\t"
 205         "mov    %%g1, %%l1\n\t"
 206         "mov    %%g5, %%l5\n\t"
 207         "call   %3\n\t"
 208         " mov   %%g1, %%o0\n\t"
 209         "mov    %%l1, %%g1\n\t"
 210         "ba     1b\n\t"
 211         " restore %%l5, %%g0, %%g5\n\t"
 212         ".previous\n"
 213         : "=&r" (increment)
 214         : "0" (increment), "r" (ptr), "i" (__up)
 215         : "g3", "g4", "g7", "memory", "cc");
 216 }
 217
 218 #endif /* __KERNEL__ */
 219
 220 #endif /* !(_SPARC_SEMAPHORE_H) */