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 } 166