|
Packit |
6c4009 |
/* Hurd helpers for lowlevellocks.
|
|
Packit |
6c4009 |
Copyright (C) 1999-2018 Free Software Foundation, Inc.
|
|
Packit |
6c4009 |
This file is part of the GNU C Library.
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
The GNU C Library is free software; you can redistribute it and/or
|
|
Packit |
6c4009 |
modify it under the terms of the GNU Lesser General Public
|
|
Packit |
6c4009 |
License as published by the Free Software Foundation; either
|
|
Packit |
6c4009 |
version 2.1 of the License, or (at your option) any later version.
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
The GNU C Library is distributed in the hope that it will be useful,
|
|
Packit |
6c4009 |
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
Packit |
6c4009 |
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
Packit |
6c4009 |
Lesser General Public License for more details.
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
You should have received a copy of the GNU Lesser General Public
|
|
Packit |
6c4009 |
License along with the GNU C Library; if not, see
|
|
Packit |
6c4009 |
<http://www.gnu.org/licenses/>. */
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
#include "hurdlock.h"
|
|
Packit |
6c4009 |
#include <hurd.h>
|
|
Packit |
6c4009 |
#include <hurd/hurd.h>
|
|
Packit |
6c4009 |
#include <time.h>
|
|
Packit |
6c4009 |
#include <errno.h>
|
|
Packit |
6c4009 |
#include <unistd.h>
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Convert an absolute timeout in nanoseconds to a relative
|
|
Packit |
6c4009 |
timeout in milliseconds. */
|
|
Packit |
6c4009 |
static inline int __attribute__ ((gnu_inline))
|
|
Packit |
6c4009 |
compute_reltime (const struct timespec *abstime, clockid_t clk)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
struct timespec ts;
|
|
Packit |
6c4009 |
__clock_gettime (clk, &ts);
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
ts.tv_sec = abstime->tv_sec - ts.tv_sec;
|
|
Packit |
6c4009 |
ts.tv_nsec = abstime->tv_nsec - ts.tv_nsec;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
if (ts.tv_nsec < 0)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
--ts.tv_sec;
|
|
Packit |
6c4009 |
ts.tv_nsec += 1000000000;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
return ts.tv_sec < 0 ? -1 : (int)(ts.tv_sec * 1000 + ts.tv_nsec / 1000000);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
int
|
|
Packit |
6c4009 |
__lll_abstimed_wait (void *ptr, int val,
|
|
Packit |
6c4009 |
const struct timespec *tsp, int flags, int clk)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
int mlsec = compute_reltime (tsp, clk);
|
|
Packit |
6c4009 |
return mlsec < 0 ? KERN_TIMEDOUT : lll_timed_wait (ptr, val, mlsec, flags);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
int
|
|
Packit |
6c4009 |
__lll_abstimed_xwait (void *ptr, int lo, int hi,
|
|
Packit |
6c4009 |
const struct timespec *tsp, int flags, int clk)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
int mlsec = compute_reltime (tsp, clk);
|
|
Packit |
6c4009 |
return mlsec < 0 ? KERN_TIMEDOUT : lll_timed_xwait (ptr, lo, hi, mlsec,
|
|
Packit |
6c4009 |
flags);
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
int
|
|
Packit |
6c4009 |
__lll_abstimed_lock (void *ptr,
|
|
Packit |
6c4009 |
const struct timespec *tsp, int flags, int clk)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
if (lll_trylock (ptr) == 0)
|
|
Packit |
6c4009 |
return 0;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
while (1)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
if (atomic_exchange_acq ((int *)ptr, 2) == 0)
|
|
Packit |
6c4009 |
return 0;
|
|
Packit |
6c4009 |
else if (tsp->tv_nsec < 0 || tsp->tv_nsec >= 1000000000)
|
|
Packit |
6c4009 |
return EINVAL;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
int mlsec = compute_reltime (tsp, clk);
|
|
Packit |
6c4009 |
if (mlsec < 0 || lll_timed_wait (ptr, 2, mlsec, flags) == KERN_TIMEDOUT)
|
|
Packit |
6c4009 |
return ETIMEDOUT;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Robust locks. */
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Test if a given process id is still valid. */
|
|
Packit |
6c4009 |
static inline int
|
|
Packit |
6c4009 |
valid_pid (int pid)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
task_t task = __pid2task (pid);
|
|
Packit |
6c4009 |
if (task == MACH_PORT_NULL)
|
|
Packit |
6c4009 |
return 0;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
__mach_port_deallocate (__mach_task_self (), task);
|
|
Packit |
6c4009 |
return 1;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Robust locks have currently no support from the kernel; they
|
|
Packit |
6c4009 |
are simply implemented with periodic polling. When sleeping, the
|
|
Packit |
6c4009 |
maximum blocking time is determined by this constant. */
|
|
Packit |
6c4009 |
#define MAX_WAIT_TIME 1500
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
int
|
|
Packit |
6c4009 |
__lll_robust_lock (void *ptr, int flags)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
int *iptr = (int *)ptr;
|
|
Packit |
6c4009 |
int id = __getpid ();
|
|
Packit |
6c4009 |
int wait_time = 25;
|
|
Packit |
6c4009 |
unsigned int val;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
/* Try to set the lock word to our PID if it's clear. Otherwise,
|
|
Packit |
6c4009 |
mark it as having waiters. */
|
|
Packit |
6c4009 |
while (1)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
val = *iptr;
|
|
Packit |
6c4009 |
if (!val && atomic_compare_and_exchange_bool_acq (iptr, id, 0) == 0)
|
|
Packit |
6c4009 |
return 0;
|
|
Packit |
6c4009 |
else if (atomic_compare_and_exchange_bool_acq (iptr,
|
|
Packit |
6c4009 |
val | LLL_WAITERS, val) == 0)
|
|
Packit |
6c4009 |
break;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
for (id |= LLL_WAITERS ; ; )
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
val = *iptr;
|
|
Packit |
6c4009 |
if (!val && atomic_compare_and_exchange_bool_acq (iptr, id, 0) == 0)
|
|
Packit |
6c4009 |
return 0;
|
|
Packit |
6c4009 |
else if (val && !valid_pid (val & LLL_OWNER_MASK))
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
if (atomic_compare_and_exchange_bool_acq (iptr, id, val) == 0)
|
|
Packit |
6c4009 |
return EOWNERDEAD;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
else
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
lll_timed_wait (iptr, val, wait_time, flags);
|
|
Packit |
6c4009 |
if (wait_time < MAX_WAIT_TIME)
|
|
Packit |
6c4009 |
wait_time <<= 1;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
int
|
|
Packit |
6c4009 |
__lll_robust_abstimed_lock (void *ptr,
|
|
Packit |
6c4009 |
const struct timespec *tsp, int flags, int clk)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
int *iptr = (int *)ptr;
|
|
Packit |
6c4009 |
int id = __getpid ();
|
|
Packit |
6c4009 |
int wait_time = 25;
|
|
Packit |
6c4009 |
unsigned int val;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
while (1)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
val = *iptr;
|
|
Packit |
6c4009 |
if (!val && atomic_compare_and_exchange_bool_acq (iptr, id, 0) == 0)
|
|
Packit |
6c4009 |
return 0;
|
|
Packit |
6c4009 |
else if (atomic_compare_and_exchange_bool_acq (iptr,
|
|
Packit |
6c4009 |
val | LLL_WAITERS, val) == 0)
|
|
Packit |
6c4009 |
break;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
for (id |= LLL_WAITERS ; ; )
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
val = *iptr;
|
|
Packit |
6c4009 |
if (!val && atomic_compare_and_exchange_bool_acq (iptr, id, 0) == 0)
|
|
Packit |
6c4009 |
return 0;
|
|
Packit |
6c4009 |
else if (val && !valid_pid (val & LLL_OWNER_MASK))
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
if (atomic_compare_and_exchange_bool_acq (iptr, id, val) == 0)
|
|
Packit |
6c4009 |
return EOWNERDEAD;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
else
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
int mlsec = compute_reltime (tsp, clk);
|
|
Packit |
6c4009 |
if (mlsec < 0)
|
|
Packit |
6c4009 |
return ETIMEDOUT;
|
|
Packit |
6c4009 |
else if (mlsec > wait_time)
|
|
Packit |
6c4009 |
mlsec = wait_time;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
int res = lll_timed_wait (iptr, val, mlsec, flags);
|
|
Packit |
6c4009 |
if (res == KERN_TIMEDOUT)
|
|
Packit |
6c4009 |
return ETIMEDOUT;
|
|
Packit |
6c4009 |
else if (wait_time < MAX_WAIT_TIME)
|
|
Packit |
6c4009 |
wait_time <<= 1;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
int
|
|
Packit |
6c4009 |
__lll_robust_trylock (void *ptr)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
int *iptr = (int *)ptr;
|
|
Packit |
6c4009 |
int id = __getpid ();
|
|
Packit |
6c4009 |
unsigned int val = *iptr;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
if (!val)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
if (atomic_compare_and_exchange_bool_acq (iptr, id, 0) == 0)
|
|
Packit |
6c4009 |
return 0;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
else if (!valid_pid (val & LLL_OWNER_MASK)
|
|
Packit |
6c4009 |
&& atomic_compare_and_exchange_bool_acq (iptr, id, val) == 0)
|
|
Packit |
6c4009 |
return EOWNERDEAD;
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
return EBUSY;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
|
|
Packit |
6c4009 |
void
|
|
Packit |
6c4009 |
__lll_robust_unlock (void *ptr, int flags)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
unsigned int val = atomic_load_relaxed ((unsigned int *)ptr);
|
|
Packit |
6c4009 |
while (1)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
if (val & LLL_WAITERS)
|
|
Packit |
6c4009 |
{
|
|
Packit |
6c4009 |
lll_set_wake (ptr, 0, flags);
|
|
Packit |
6c4009 |
break;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
else if (atomic_compare_exchange_weak_release ((unsigned int *)ptr, &val, 0))
|
|
Packit |
6c4009 |
break;
|
|
Packit |
6c4009 |
}
|
|
Packit |
6c4009 |
}
|