lib/libthr/thread/thr_umtx.c

   1 /*
   2  * Copyright (c) 2005 David Xu <davidxu@freebsd.org>
   3  * All rights reserved.
   4  *
   5  * Redistribution and use in source and binary forms, with or without
   6  * modification, are permitted provided that the following conditions
   7  * are met:
   8  * 1. Redistributions of source code must retain the above copyright
   9  *    notice unmodified, this list of conditions, and the following
  10  *    disclaimer.
  11  * 2. Redistributions in binary form must reproduce the above copyright
  12  *    notice, this list of conditions and the following disclaimer in the
  13  *    documentation and/or other materials provided with the distribution.
  14  *
  15  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR ``AS IS'' AND ANY EXPRESS OR
  16  * IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES
  17  * OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE DISCLAIMED.
  18  * IN NO EVENT SHALL THE AUTHOR BE LIABLE FOR ANY DIRECT, INDIRECT,
  19  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT
  20  * NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE,
  21  * DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY
  22  * THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
  23  * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
  24  * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
  25  *
  26  * $FreeBSD$
  27  *
  28  */
  29
  30 #include "thr_private.h"
  31 #include "thr_umtx.h"
  32
  33 #ifndef HAS__UMTX_OP_ERR
  34 int _umtx_op_err(void *obj, int op, u_long val, void *uaddr, void *uaddr2)
  35 {
  36         if (_umtx_op(obj, op, val, uaddr, uaddr2) == -1)
  37                 return (errno);
  38         return (0);
  39 }
  40 #endif
  41
  42 void
  43 _thr_umutex_init(struct umutex *mtx)
  44 {
  45         static struct umutex default_mtx = DEFAULT_UMUTEX;
  46
  47         *mtx = default_mtx;
  48 }
  49
  50 int
  51 __thr_umutex_lock(struct umutex *mtx)
  52 {
  53         return _umtx_op_err(mtx, UMTX_OP_MUTEX_LOCK, 0, 0, 0);
  54 }
  55
  56 int
  57 __thr_umutex_timedlock(struct umutex *mtx,
  58         const struct timespec *timeout)
  59 {
  60         if (timeout && (timeout->tv_sec < 0 || (timeout->tv_sec == 0 &&
  61                 timeout->tv_nsec <= 0)))
  62                 return (ETIMEDOUT);
  63         return _umtx_op_err(mtx, UMTX_OP_MUTEX_LOCK, 0, 0,
  64                 __DECONST(void *, timeout));
  65 }
  66
  67 int
  68 __thr_umutex_unlock(struct umutex *mtx)
  69 {
  70         return _umtx_op_err(mtx, UMTX_OP_MUTEX_UNLOCK, 0, 0, 0);
  71 }
  72
  73 int
  74 __thr_umutex_trylock(struct umutex *mtx)
  75 {
  76         return _umtx_op_err(mtx, UMTX_OP_MUTEX_TRYLOCK, 0, 0, 0);
  77 }
  78
  79 int
  80 __thr_umutex_set_ceiling(struct umutex *mtx, uint32_t ceiling,
  81         uint32_t *oldceiling)
  82 {
  83         return _umtx_op_err(mtx, UMTX_OP_SET_CEILING, ceiling, oldceiling, 0);
  84 }
  85
  86 int
  87 _thr_umtx_wait(volatile long *mtx, long id, const struct timespec *timeout)
  88 {
  89         if (timeout && (timeout->tv_sec < 0 || (timeout->tv_sec == 0 &&
  90                 timeout->tv_nsec <= 0)))
  91                 return (ETIMEDOUT);
  92         return _umtx_op_err(__DEVOLATILE(void *, mtx), UMTX_OP_WAIT, id, 0,
  93                 __DECONST(void*, timeout));
  94 }
  95
  96 int
  97 _thr_umtx_wait_uint(volatile u_int *mtx, u_int id, const struct timespec *timeout)
  98 {
  99         if (timeout && (timeout->tv_sec < 0 || (timeout->tv_sec == 0 &&
 100                 timeout->tv_nsec <= 0)))
 101                 return (ETIMEDOUT);
 102         return _umtx_op_err(__DEVOLATILE(void *, mtx), UMTX_OP_WAIT_UINT, id, 0,
 103                 __DECONST(void*, timeout));
 104 }
 105
 106 int
 107 _thr_umtx_wake(volatile void *mtx, int nr_wakeup)
 108 {
 109         return _umtx_op_err(__DEVOLATILE(void *, mtx), UMTX_OP_WAKE,
 110                 nr_wakeup, 0, 0);
 111 }
 112
 113 void
 114 _thr_ucond_init(struct ucond *cv)
 115 {
 116         bzero(cv, sizeof(struct ucond));
 117 }
 118
 119 int
 120 _thr_ucond_wait(struct ucond *cv, struct umutex *m,
 121         const struct timespec *timeout, int check_unparking)
 122 {
 123         if (timeout && (timeout->tv_sec < 0 || (timeout->tv_sec == 0 &&
 124             timeout->tv_nsec <= 0))) {
 125                 __thr_umutex_unlock(m);
 126                 return (ETIMEDOUT);
 127         }
 128         return _umtx_op_err(cv, UMTX_OP_CV_WAIT,
 129                      check_unparking ? UMTX_CHECK_UNPARKING : 0,
 130                      m, __DECONST(void*, timeout));
 131 }
 132
 133 int
 134 _thr_ucond_signal(struct ucond *cv)
 135 {
 136         if (!cv->c_has_waiters)
 137                 return (0);
 138         return _umtx_op_err(cv, UMTX_OP_CV_SIGNAL, 0, NULL, NULL);
 139 }
 140
 141 int
 142 _thr_ucond_broadcast(struct ucond *cv)
 143 {
 144         if (!cv->c_has_waiters)
 145                 return (0);
 146         return _umtx_op_err(cv, UMTX_OP_CV_BROADCAST, 0, NULL, NULL);
 147 }
 148
 149 int
 150 __thr_rwlock_rdlock(struct urwlock *rwlock, int flags, struct timespec *tsp)
 151 {
 152         return _umtx_op_err(rwlock, UMTX_OP_RW_RDLOCK, flags, NULL, tsp);
 153 }
 154
 155 int
 156 __thr_rwlock_wrlock(struct urwlock *rwlock, struct timespec *tsp)
 157 {
 158         return _umtx_op_err(rwlock, UMTX_OP_RW_WRLOCK, 0, NULL, tsp);
 159 }
 160
 161 int
 162 __thr_rwlock_unlock(struct urwlock *rwlock)
 163 {
 164         return _umtx_op_err(rwlock, UMTX_OP_RW_UNLOCK, 0, NULL, NULL);
 165 }