#include <mach/mach_types.h>
#include <mach/mach_traps.h>
#include <mach/kern_return.h>
#include <mach/semaphore.h>
#include <mach/sync_policy.h>
#include <mach/task.h>
#include <kern/misc_protos.h>
#include <kern/sync_sema.h>
#include <kern/spl.h>
#include <kern/ipc_kobject.h>
#include <kern/ipc_sync.h>
#include <kern/ipc_tt.h>
#include <kern/thread.h>
#include <kern/clock.h>
#include <ipc/ipc_port.h>
#include <ipc/ipc_space.h>
#include <kern/host.h>
#include <kern/wait_queue.h>
#include <kern/zalloc.h>
#include <kern/mach_param.h>
#include <libkern/OSAtomic.h>
static unsigned int semaphore_event;
#define SEMAPHORE_EVENT CAST_EVENT64_T(&semaphore_event)
zone_t semaphore_zone;
unsigned int semaphore_max;
kern_return_t
semaphore_wait_trap_internal(
mach_port_name_t name,
void (*caller_cont)(kern_return_t));
kern_return_t
semaphore_wait_signal_trap_internal(
mach_port_name_t wait_name,
mach_port_name_t signal_name,
void (*caller_cont)(kern_return_t));
kern_return_t
semaphore_timedwait_trap_internal(
mach_port_name_t name,
unsigned int sec,
clock_res_t nsec,
void (*caller_cont)(kern_return_t));
kern_return_t
semaphore_timedwait_signal_trap_internal(
mach_port_name_t wait_name,
mach_port_name_t signal_name,
unsigned int sec,
clock_res_t nsec,
void (*caller_cont)(kern_return_t));
kern_return_t
semaphore_signal_internal_trap(mach_port_name_t sema_name);
kern_return_t
semaphore_signal_internal(
semaphore_t semaphore,
thread_t thread,
int options);
kern_return_t
semaphore_convert_wait_result(
int wait_result);
void
semaphore_wait_continue(void);
static kern_return_t
semaphore_wait_internal(
semaphore_t wait_semaphore,
semaphore_t signal_semaphore,
uint64_t deadline,
int option,
void (*caller_cont)(kern_return_t));
static __inline__ uint64_t
semaphore_deadline(
unsigned int sec,
clock_res_t nsec)
{
uint64_t abstime;
nanoseconds_to_absolutetime((uint64_t)sec * NSEC_PER_SEC + nsec, &abstime);
clock_absolutetime_interval_to_deadline(abstime, &abstime);
return (abstime);
}
void
semaphore_init(void)
{
semaphore_zone = zinit(sizeof(struct semaphore),
semaphore_max * sizeof(struct semaphore),
sizeof(struct semaphore),
"semaphores");
zone_change(semaphore_zone, Z_NOENCRYPT, TRUE);
}
kern_return_t
semaphore_create(
task_t task,
semaphore_t *new_semaphore,
int policy,
int value)
{
semaphore_t s = SEMAPHORE_NULL;
kern_return_t kret;
*new_semaphore = SEMAPHORE_NULL;
if (task == TASK_NULL || value < 0 || policy > SYNC_POLICY_MAX)
return KERN_INVALID_ARGUMENT;
s = (semaphore_t) zalloc (semaphore_zone);
if (s == SEMAPHORE_NULL)
return KERN_RESOURCE_SHORTAGE;
kret = wait_queue_init(&s->wait_queue, policy);
if (kret != KERN_SUCCESS) {
zfree(semaphore_zone, s);
return kret;
}
s->count = value;
s->ref_count = (task == kernel_task) ? 2 : 3;
s->port = ipc_port_alloc_kernel();
if (s->port == IP_NULL) {
zfree(semaphore_zone, s);
return KERN_RESOURCE_SHORTAGE;
}
ipc_kobject_set (s->port, (ipc_kobject_t) s, IKOT_SEMAPHORE);
task_lock(task);
enqueue_head(&task->semaphore_list, (queue_entry_t) s);
task->semaphores_owned++;
s->owner = task;
s->active = TRUE;
task_unlock(task);
*new_semaphore = s;
return KERN_SUCCESS;
}
kern_return_t
semaphore_destroy(
task_t task,
semaphore_t semaphore)
{
int old_count;
spl_t spl_level;
if (task == TASK_NULL || semaphore == SEMAPHORE_NULL)
return KERN_INVALID_ARGUMENT;
task_lock(task);
if (semaphore->owner != task) {
task_unlock(task);
return KERN_INVALID_ARGUMENT;
}
remqueue((queue_entry_t) semaphore);
semaphore->owner = TASK_NULL;
task->semaphores_owned--;
task_unlock(task);
spl_level = splsched();
semaphore_lock(semaphore);
assert(semaphore->active);
semaphore->active = FALSE;
old_count = semaphore->count;
semaphore->count = 0;
if (old_count < 0) {
wait_queue_wakeup64_all_locked(&semaphore->wait_queue,
SEMAPHORE_EVENT,
THREAD_RESTART,
TRUE);
} else {
semaphore_unlock(semaphore);
}
splx(spl_level);
semaphore_dereference(semaphore);
return KERN_SUCCESS;
}
kern_return_t
semaphore_signal_internal(
semaphore_t semaphore,
thread_t thread,
int options)
{
kern_return_t kr;
spl_t spl_level;
spl_level = splsched();
semaphore_lock(semaphore);
if (!semaphore->active) {
semaphore_unlock(semaphore);
splx(spl_level);
return KERN_TERMINATED;
}
if (thread != THREAD_NULL) {
if (semaphore->count < 0) {
kr = wait_queue_wakeup64_thread_locked(
&semaphore->wait_queue,
SEMAPHORE_EVENT,
thread,
THREAD_AWAKENED,
TRUE);
} else {
semaphore_unlock(semaphore);
kr = KERN_NOT_WAITING;
}
splx(spl_level);
return kr;
}
if (options & SEMAPHORE_SIGNAL_ALL) {
int old_count = semaphore->count;
if (old_count < 0) {
semaphore->count = 0;
kr = wait_queue_wakeup64_all_locked(
&semaphore->wait_queue,
SEMAPHORE_EVENT,
THREAD_AWAKENED,
TRUE);
} else {
if (options & SEMAPHORE_SIGNAL_PREPOST)
semaphore->count++;
semaphore_unlock(semaphore);
kr = KERN_SUCCESS;
}
splx(spl_level);
return kr;
}
if (semaphore->count < 0) {
if (wait_queue_wakeup64_one_locked(
&semaphore->wait_queue,
SEMAPHORE_EVENT,
THREAD_AWAKENED,
FALSE) == KERN_SUCCESS) {
semaphore_unlock(semaphore);
splx(spl_level);
return KERN_SUCCESS;
} else
semaphore->count = 0;
}
if (options & SEMAPHORE_SIGNAL_PREPOST) {
semaphore->count++;
}
semaphore_unlock(semaphore);
splx(spl_level);
return KERN_NOT_WAITING;
}
kern_return_t
semaphore_signal_thread(
semaphore_t semaphore,
thread_t thread)
{
kern_return_t ret;
if (semaphore == SEMAPHORE_NULL)
return KERN_INVALID_ARGUMENT;
ret = semaphore_signal_internal(semaphore,
thread,
SEMAPHORE_OPTION_NONE);
return ret;
}
kern_return_t
semaphore_signal_thread_trap(
struct semaphore_signal_thread_trap_args *args)
{
mach_port_name_t sema_name = args->signal_name;
mach_port_name_t thread_name = args->thread_name;
semaphore_t semaphore;
thread_t thread;
kern_return_t kr;
if (thread_name != MACH_PORT_NULL) {
thread = port_name_to_thread(thread_name);
if (thread == THREAD_NULL)
return KERN_INVALID_ARGUMENT;
} else
thread = THREAD_NULL;
kr = port_name_to_semaphore(sema_name, &semaphore);
if (kr == KERN_SUCCESS) {
kr = semaphore_signal_internal(semaphore,
thread,
SEMAPHORE_OPTION_NONE);
semaphore_dereference(semaphore);
}
if (thread != THREAD_NULL) {
thread_deallocate(thread);
}
return kr;
}
kern_return_t
semaphore_signal(
semaphore_t semaphore)
{
kern_return_t kr;
if (semaphore == SEMAPHORE_NULL)
return KERN_INVALID_ARGUMENT;
kr = semaphore_signal_internal(semaphore,
THREAD_NULL,
SEMAPHORE_SIGNAL_PREPOST);
if (kr == KERN_NOT_WAITING)
return KERN_SUCCESS;
return kr;
}
kern_return_t
semaphore_signal_trap(
struct semaphore_signal_trap_args *args)
{
mach_port_name_t sema_name = args->signal_name;
return (semaphore_signal_internal_trap(sema_name));
}
kern_return_t
semaphore_signal_internal_trap(mach_port_name_t sema_name)
{
semaphore_t semaphore;
kern_return_t kr;
kr = port_name_to_semaphore(sema_name, &semaphore);
if (kr == KERN_SUCCESS) {
kr = semaphore_signal_internal(semaphore,
THREAD_NULL,
SEMAPHORE_SIGNAL_PREPOST);
semaphore_dereference(semaphore);
if (kr == KERN_NOT_WAITING)
kr = KERN_SUCCESS;
}
return kr;
}
kern_return_t
semaphore_signal_all(
semaphore_t semaphore)
{
kern_return_t kr;
if (semaphore == SEMAPHORE_NULL)
return KERN_INVALID_ARGUMENT;
kr = semaphore_signal_internal(semaphore,
THREAD_NULL,
SEMAPHORE_SIGNAL_ALL);
if (kr == KERN_NOT_WAITING)
return KERN_SUCCESS;
return kr;
}
kern_return_t
semaphore_signal_all_trap(
struct semaphore_signal_all_trap_args *args)
{
mach_port_name_t sema_name = args->signal_name;
semaphore_t semaphore;
kern_return_t kr;
kr = port_name_to_semaphore(sema_name, &semaphore);
if (kr == KERN_SUCCESS) {
kr = semaphore_signal_internal(semaphore,
THREAD_NULL,
SEMAPHORE_SIGNAL_ALL);
semaphore_dereference(semaphore);
if (kr == KERN_NOT_WAITING)
kr = KERN_SUCCESS;
}
return kr;
}
kern_return_t
semaphore_convert_wait_result(int wait_result)
{
switch (wait_result) {
case THREAD_AWAKENED:
return KERN_SUCCESS;
case THREAD_TIMED_OUT:
return KERN_OPERATION_TIMED_OUT;
case THREAD_INTERRUPTED:
return KERN_ABORTED;
case THREAD_RESTART:
return KERN_TERMINATED;
default:
panic("semaphore_block\n");
return KERN_FAILURE;
}
}
void
semaphore_wait_continue(void)
{
thread_t self = current_thread();
int wait_result = self->wait_result;
void (*caller_cont)(kern_return_t) = self->sth_continuation;
assert(self->sth_waitsemaphore != SEMAPHORE_NULL);
semaphore_dereference(self->sth_waitsemaphore);
if (self->sth_signalsemaphore != SEMAPHORE_NULL)
semaphore_dereference(self->sth_signalsemaphore);
assert(caller_cont != (void (*)(kern_return_t))0);
(*caller_cont)(semaphore_convert_wait_result(wait_result));
}
static kern_return_t
semaphore_wait_internal(
semaphore_t wait_semaphore,
semaphore_t signal_semaphore,
uint64_t deadline,
int option,
void (*caller_cont)(kern_return_t))
{
int wait_result;
spl_t spl_level;
kern_return_t kr = KERN_ALREADY_WAITING;
spl_level = splsched();
semaphore_lock(wait_semaphore);
if (!wait_semaphore->active) {
kr = KERN_TERMINATED;
} else if (wait_semaphore->count > 0) {
wait_semaphore->count--;
kr = KERN_SUCCESS;
} else if (option & SEMAPHORE_TIMEOUT_NOBLOCK) {
kr = KERN_OPERATION_TIMED_OUT;
} else {
thread_t self = current_thread();
wait_semaphore->count = -1;
thread_lock(self);
(void)wait_queue_assert_wait64_locked(
&wait_semaphore->wait_queue,
SEMAPHORE_EVENT,
THREAD_ABORTSAFE,
TIMEOUT_URGENCY_USER_NORMAL,
deadline, 0,
self);
thread_unlock(self);
}
semaphore_unlock(wait_semaphore);
splx(spl_level);
if (signal_semaphore != SEMAPHORE_NULL) {
kern_return_t signal_kr;
signal_kr = semaphore_signal_internal(signal_semaphore,
THREAD_NULL,
SEMAPHORE_SIGNAL_PREPOST);
if (signal_kr == KERN_NOT_WAITING)
signal_kr = KERN_SUCCESS;
else if (signal_kr == KERN_TERMINATED) {
thread_t self = current_thread();
clear_wait(self, THREAD_INTERRUPTED);
kr = semaphore_convert_wait_result(self->wait_result);
if (kr == KERN_ABORTED)
kr = KERN_TERMINATED;
}
}
if (kr != KERN_ALREADY_WAITING)
return kr;
if (caller_cont) {
thread_t self = current_thread();
self->sth_continuation = caller_cont;
self->sth_waitsemaphore = wait_semaphore;
self->sth_signalsemaphore = signal_semaphore;
wait_result = thread_block((thread_continue_t)semaphore_wait_continue);
}
else {
wait_result = thread_block(THREAD_CONTINUE_NULL);
}
return (semaphore_convert_wait_result(wait_result));
}
kern_return_t
semaphore_wait(
semaphore_t semaphore)
{
if (semaphore == SEMAPHORE_NULL)
return KERN_INVALID_ARGUMENT;
return(semaphore_wait_internal(semaphore,
SEMAPHORE_NULL,
0ULL, SEMAPHORE_OPTION_NONE,
(void (*)(kern_return_t))0));
}
kern_return_t
semaphore_wait_noblock(
semaphore_t semaphore)
{
if (semaphore == SEMAPHORE_NULL)
return KERN_INVALID_ARGUMENT;
return(semaphore_wait_internal(semaphore,
SEMAPHORE_NULL,
0ULL, SEMAPHORE_TIMEOUT_NOBLOCK,
(void (*)(kern_return_t))0));
}
kern_return_t
semaphore_wait_deadline(
semaphore_t semaphore,
uint64_t deadline)
{
if (semaphore == SEMAPHORE_NULL)
return KERN_INVALID_ARGUMENT;
return(semaphore_wait_internal(semaphore,
SEMAPHORE_NULL,
deadline, SEMAPHORE_OPTION_NONE,
(void (*)(kern_return_t))0));
}
kern_return_t
semaphore_wait_trap(
struct semaphore_wait_trap_args *args)
{
return(semaphore_wait_trap_internal(args->wait_name, thread_syscall_return));
}
kern_return_t
semaphore_wait_trap_internal(
mach_port_name_t name,
void (*caller_cont)(kern_return_t))
{
semaphore_t semaphore;
kern_return_t kr;
kr = port_name_to_semaphore(name, &semaphore);
if (kr == KERN_SUCCESS) {
kr = semaphore_wait_internal(semaphore,
SEMAPHORE_NULL,
0ULL, SEMAPHORE_OPTION_NONE,
caller_cont);
semaphore_dereference(semaphore);
}
return kr;
}
kern_return_t
semaphore_timedwait(
semaphore_t semaphore,
mach_timespec_t wait_time)
{
int option = SEMAPHORE_OPTION_NONE;
uint64_t deadline = 0;
if (semaphore == SEMAPHORE_NULL)
return KERN_INVALID_ARGUMENT;
if(BAD_MACH_TIMESPEC(&wait_time))
return KERN_INVALID_VALUE;
if (wait_time.tv_sec == 0 && wait_time.tv_nsec == 0)
option = SEMAPHORE_TIMEOUT_NOBLOCK;
else
deadline = semaphore_deadline(wait_time.tv_sec, wait_time.tv_nsec);
return (semaphore_wait_internal(semaphore,
SEMAPHORE_NULL,
deadline, option,
(void(*)(kern_return_t))0));
}
kern_return_t
semaphore_timedwait_trap(
struct semaphore_timedwait_trap_args *args)
{
return(semaphore_timedwait_trap_internal(args->wait_name, args->sec, args->nsec, thread_syscall_return));
}
kern_return_t
semaphore_timedwait_trap_internal(
mach_port_name_t name,
unsigned int sec,
clock_res_t nsec,
void (*caller_cont)(kern_return_t))
{
semaphore_t semaphore;
mach_timespec_t wait_time;
kern_return_t kr;
wait_time.tv_sec = sec;
wait_time.tv_nsec = nsec;
if(BAD_MACH_TIMESPEC(&wait_time))
return KERN_INVALID_VALUE;
kr = port_name_to_semaphore(name, &semaphore);
if (kr == KERN_SUCCESS) {
int option = SEMAPHORE_OPTION_NONE;
uint64_t deadline = 0;
if (sec == 0 && nsec == 0)
option = SEMAPHORE_TIMEOUT_NOBLOCK;
else
deadline = semaphore_deadline(sec, nsec);
kr = semaphore_wait_internal(semaphore,
SEMAPHORE_NULL,
deadline, option,
caller_cont);
semaphore_dereference(semaphore);
}
return kr;
}
kern_return_t
semaphore_wait_signal(
semaphore_t wait_semaphore,
semaphore_t signal_semaphore)
{
if (wait_semaphore == SEMAPHORE_NULL)
return KERN_INVALID_ARGUMENT;
return(semaphore_wait_internal(wait_semaphore,
signal_semaphore,
0ULL, SEMAPHORE_OPTION_NONE,
(void(*)(kern_return_t))0));
}
kern_return_t
semaphore_wait_signal_trap(
struct semaphore_wait_signal_trap_args *args)
{
return(semaphore_wait_signal_trap_internal(args->wait_name, args->signal_name, thread_syscall_return));
}
kern_return_t
semaphore_wait_signal_trap_internal(
mach_port_name_t wait_name,
mach_port_name_t signal_name,
void (*caller_cont)(kern_return_t))
{
semaphore_t wait_semaphore;
semaphore_t signal_semaphore;
kern_return_t kr;
kr = port_name_to_semaphore(signal_name, &signal_semaphore);
if (kr == KERN_SUCCESS) {
kr = port_name_to_semaphore(wait_name, &wait_semaphore);
if (kr == KERN_SUCCESS) {
kr = semaphore_wait_internal(wait_semaphore,
signal_semaphore,
0ULL, SEMAPHORE_OPTION_NONE,
caller_cont);
semaphore_dereference(wait_semaphore);
}
semaphore_dereference(signal_semaphore);
}
return kr;
}
kern_return_t
semaphore_timedwait_signal(
semaphore_t wait_semaphore,
semaphore_t signal_semaphore,
mach_timespec_t wait_time)
{
int option = SEMAPHORE_OPTION_NONE;
uint64_t deadline = 0;
if (wait_semaphore == SEMAPHORE_NULL)
return KERN_INVALID_ARGUMENT;
if(BAD_MACH_TIMESPEC(&wait_time))
return KERN_INVALID_VALUE;
if (wait_time.tv_sec == 0 && wait_time.tv_nsec == 0)
option = SEMAPHORE_TIMEOUT_NOBLOCK;
else
deadline = semaphore_deadline(wait_time.tv_sec, wait_time.tv_nsec);
return(semaphore_wait_internal(wait_semaphore,
signal_semaphore,
deadline, option,
(void(*)(kern_return_t))0));
}
kern_return_t
semaphore_timedwait_signal_trap(
struct semaphore_timedwait_signal_trap_args *args)
{
return(semaphore_timedwait_signal_trap_internal(args->wait_name, args->signal_name, args->sec, args->nsec, thread_syscall_return));
}
kern_return_t
semaphore_timedwait_signal_trap_internal(
mach_port_name_t wait_name,
mach_port_name_t signal_name,
unsigned int sec,
clock_res_t nsec,
void (*caller_cont)(kern_return_t))
{
semaphore_t wait_semaphore;
semaphore_t signal_semaphore;
mach_timespec_t wait_time;
kern_return_t kr;
wait_time.tv_sec = sec;
wait_time.tv_nsec = nsec;
if(BAD_MACH_TIMESPEC(&wait_time))
return KERN_INVALID_VALUE;
kr = port_name_to_semaphore(signal_name, &signal_semaphore);
if (kr == KERN_SUCCESS) {
kr = port_name_to_semaphore(wait_name, &wait_semaphore);
if (kr == KERN_SUCCESS) {
int option = SEMAPHORE_OPTION_NONE;
uint64_t deadline = 0;
if (sec == 0 && nsec == 0)
option = SEMAPHORE_TIMEOUT_NOBLOCK;
else
deadline = semaphore_deadline(sec, nsec);
kr = semaphore_wait_internal(wait_semaphore,
signal_semaphore,
deadline, option,
caller_cont);
semaphore_dereference(wait_semaphore);
}
semaphore_dereference(signal_semaphore);
}
return kr;
}
void
semaphore_reference(
semaphore_t semaphore)
{
(void)hw_atomic_add(&semaphore->ref_count, 1);
}
void
semaphore_dereference(
semaphore_t semaphore)
{
int ref_count;
if (semaphore != NULL) {
ref_count = hw_atomic_sub(&semaphore->ref_count, 1);
if (ref_count == 1) {
ipc_port_t port = semaphore->port;
if (IP_VALID(port) &&
OSCompareAndSwapPtr(port, IP_NULL, &semaphore->port)) {
ipc_port_dealloc_kernel(port);
ref_count = hw_atomic_sub(&semaphore->ref_count, 1);
}
}
if (ref_count == 0) {
assert(wait_queue_empty(&semaphore->wait_queue));
zfree(semaphore_zone, semaphore);
}
}
}