#include <cpus.h>
#include <mach_host.h>
#include <mach/boolean.h>
#include <mach/processor_info.h>
#include <mach/vm_param.h>
#include <machine/mach_param.h>
#include <kern/cpu_number.h>
#include <kern/misc_protos.h>
#include <kern/lock.h>
#include <kern/host.h>
#include <kern/spl.h>
#include <kern/thread.h>
#include <kern/thread_swap.h>
#include <kern/ipc_host.h>
#include <kern/clock.h>
#include <kern/zalloc.h>
#include <ipc/ipc_port.h>
#include <mach/mach_syscalls.h>
#include <mach/clock_reply.h>
#include <mach/mach_time.h>
#include <kern/mk_timer.h>
#include <mach/clock_server.h>
#include <mach/mach_host_server.h>
decl_simple_lock_data(static,ClockLock)
static struct zone *alarm_zone;
static struct alarm *alrmfree;
static struct alarm *alrmdone;
static long alrm_seqno;
static thread_call_data_t alarm_deliver;
int hz = HZ;
int tick = (1000000 / HZ);
extern struct clock clock_list[];
extern int clock_count;
static
void flush_alarms(
clock_t clock);
static
void post_alarm(
clock_t clock,
alarm_t alarm);
static
int check_time(
alarm_type_t alarm_type,
mach_timespec_t *alarm_time,
mach_timespec_t *clock_time);
static
void clock_alarm_deliver(
thread_call_param_t p0,
thread_call_param_t p1);
#define LOCK_CLOCK(s) \
s = splclock(); \
simple_lock(&ClockLock);
#define UNLOCK_CLOCK(s) \
simple_unlock(&ClockLock); \
splx(s);
void
clock_config(void)
{
clock_t clock;
register int i;
if (cpu_number() != master_cpu)
panic("clock_config");
simple_lock_init(&ClockLock, ETAP_MISC_CLOCK);
for (i = 0; i < clock_count; i++) {
clock = &clock_list[i];
if (clock->cl_ops) {
if ((*clock->cl_ops->c_config)() == 0)
clock->cl_ops = 0;
}
}
alrm_seqno = 0;
}
void
clock_init(void)
{
clock_t clock;
register int i;
for (i = 0; i < clock_count; i++) {
clock = &clock_list[i];
if (clock->cl_ops)
(*clock->cl_ops->c_init)();
}
}
void
clock_service_create(void)
{
clock_t clock;
register int i;
mk_timer_initialize();
for (i = 0; i < clock_count; i++) {
clock = &clock_list[i];
if (clock->cl_ops) {
ipc_clock_init(clock);
ipc_clock_enable(clock);
}
}
i = sizeof(struct alarm);
alarm_zone = zinit(i, (4096/i)*i, 10*i, "alarms");
thread_call_setup(&alarm_deliver, clock_alarm_deliver, NULL);
}
kern_return_t
host_get_clock_service(
host_t host,
clock_id_t clock_id,
clock_t *clock)
{
if (host == HOST_NULL || clock_id < 0 || clock_id >= clock_count) {
*clock = CLOCK_NULL;
return (KERN_INVALID_ARGUMENT);
}
*clock = &clock_list[clock_id];
if ((*clock)->cl_ops == 0)
return (KERN_FAILURE);
return (KERN_SUCCESS);
}
kern_return_t
host_get_clock_control(
host_priv_t host_priv,
clock_id_t clock_id,
clock_t *clock)
{
if (host_priv == HOST_PRIV_NULL || clock_id < 0 || clock_id >= clock_count) {
*clock = CLOCK_NULL;
return (KERN_INVALID_ARGUMENT);
}
*clock = &clock_list[clock_id];
if ((*clock)->cl_ops == 0)
return (KERN_FAILURE);
return (KERN_SUCCESS);
}
kern_return_t
clock_get_time(
clock_t clock,
mach_timespec_t *cur_time)
{
if (clock == CLOCK_NULL)
return (KERN_INVALID_ARGUMENT);
return ((*clock->cl_ops->c_gettime)(cur_time));
}
kern_return_t
clock_get_attributes(
clock_t clock,
clock_flavor_t flavor,
clock_attr_t attr,
mach_msg_type_number_t *count)
{
kern_return_t (*getattr)(
clock_flavor_t flavor,
clock_attr_t attr,
mach_msg_type_number_t *count);
if (clock == CLOCK_NULL)
return (KERN_INVALID_ARGUMENT);
if (getattr = clock->cl_ops->c_getattr)
return((*getattr)(flavor, attr, count));
else
return (KERN_FAILURE);
}
kern_return_t
clock_set_time(
clock_t clock,
mach_timespec_t new_time)
{
mach_timespec_t *clock_time;
kern_return_t (*settime)(
mach_timespec_t *clock_time);
if (clock == CLOCK_NULL)
return (KERN_INVALID_ARGUMENT);
if ((settime = clock->cl_ops->c_settime) == 0)
return (KERN_FAILURE);
clock_time = &new_time;
if (BAD_MACH_TIMESPEC(clock_time))
return (KERN_INVALID_VALUE);
flush_alarms(clock);
return ((*settime)(clock_time));
}
kern_return_t
clock_set_attributes(
clock_t clock,
clock_flavor_t flavor,
clock_attr_t attr,
mach_msg_type_number_t count)
{
kern_return_t (*setattr)(
clock_flavor_t flavor,
clock_attr_t attr,
mach_msg_type_number_t count);
if (clock == CLOCK_NULL)
return (KERN_INVALID_ARGUMENT);
if (setattr = clock->cl_ops->c_setattr)
return ((*setattr)(flavor, attr, count));
else
return (KERN_FAILURE);
}
kern_return_t
clock_alarm(
clock_t clock,
alarm_type_t alarm_type,
mach_timespec_t alarm_time,
ipc_port_t alarm_port,
mach_msg_type_name_t alarm_port_type)
{
alarm_t alarm;
mach_timespec_t clock_time;
int chkstat;
kern_return_t reply_code;
spl_t s;
if (clock == CLOCK_NULL)
return (KERN_INVALID_ARGUMENT);
if (clock->cl_ops->c_setalrm == 0)
return (KERN_FAILURE);
if (IP_VALID(alarm_port) == 0)
return (KERN_INVALID_CAPABILITY);
(*clock->cl_ops->c_gettime)(&clock_time);
chkstat = check_time(alarm_type, &alarm_time, &clock_time);
if (chkstat <= 0) {
reply_code = (chkstat < 0 ? KERN_INVALID_VALUE : KERN_SUCCESS);
clock_alarm_reply(alarm_port, alarm_port_type,
reply_code, alarm_type, clock_time);
return (KERN_SUCCESS);
}
LOCK_CLOCK(s);
if ((alarm = alrmfree) == 0) {
UNLOCK_CLOCK(s);
alarm = (alarm_t) zalloc(alarm_zone);
if (alarm == 0)
return (KERN_RESOURCE_SHORTAGE);
LOCK_CLOCK(s);
}
else
alrmfree = alarm->al_next;
alarm->al_status = ALARM_CLOCK;
alarm->al_time = alarm_time;
alarm->al_type = alarm_type;
alarm->al_port = alarm_port;
alarm->al_port_type = alarm_port_type;
alarm->al_clock = clock;
alarm->al_seqno = alrm_seqno++;
post_alarm(clock, alarm);
UNLOCK_CLOCK(s);
return (KERN_SUCCESS);
}
kern_return_t
clock_sleep_trap(
mach_port_name_t clock_name,
sleep_type_t sleep_type,
int sleep_sec,
int sleep_nsec,
mach_timespec_t *wakeup_time)
{
clock_t clock;
mach_timespec_t swtime;
kern_return_t rvalue;
if (clock_name != MACH_PORT_NULL)
clock = port_name_to_clock(clock_name);
else
clock = &clock_list[SYSTEM_CLOCK];
swtime.tv_sec = sleep_sec;
swtime.tv_nsec = sleep_nsec;
rvalue = clock_sleep_internal(clock, sleep_type, &swtime);
if (rvalue != KERN_INVALID_ARGUMENT && rvalue != KERN_FAILURE) {
copyout((char *)&swtime, (char *)wakeup_time,
sizeof(mach_timespec_t));
}
return (rvalue);
}
kern_return_t
clock_sleep_internal(
clock_t clock,
sleep_type_t sleep_type,
mach_timespec_t *sleep_time)
{
alarm_t alarm;
mach_timespec_t clock_time;
kern_return_t rvalue;
int chkstat;
spl_t s;
if (clock == CLOCK_NULL)
return (KERN_INVALID_ARGUMENT);
if (clock->cl_ops->c_setalrm == 0)
return (KERN_FAILURE);
(*clock->cl_ops->c_gettime)(&clock_time);
chkstat = check_time(sleep_type, sleep_time, &clock_time);
if (chkstat < 0)
return (KERN_INVALID_VALUE);
rvalue = KERN_SUCCESS;
if (chkstat > 0) {
LOCK_CLOCK(s);
if ((alarm = alrmfree) == 0) {
UNLOCK_CLOCK(s);
alarm = (alarm_t) zalloc(alarm_zone);
if (alarm == 0)
return (KERN_RESOURCE_SHORTAGE);
LOCK_CLOCK(s);
}
else
alrmfree = alarm->al_next;
alarm->al_time = *sleep_time;
alarm->al_status = ALARM_SLEEP;
post_alarm(clock, alarm);
assert_wait((event_t)alarm, THREAD_ABORTSAFE);
UNLOCK_CLOCK(s);
thread_block((void (*)(void)) 0);
LOCK_CLOCK(s);
if (alarm->al_status != ALARM_DONE) {
if ((alarm->al_prev)->al_next = alarm->al_next)
(alarm->al_next)->al_prev = alarm->al_prev;
rvalue = KERN_ABORTED;
}
*sleep_time = alarm->al_time;
alarm->al_status = ALARM_FREE;
alarm->al_next = alrmfree;
alrmfree = alarm;
UNLOCK_CLOCK(s);
}
else
*sleep_time = clock_time;
return (rvalue);
}
void
clock_alarm_intr(
clock_id_t clock_id,
mach_timespec_t *clock_time)
{
clock_t clock;
register alarm_t alrm1;
register alarm_t alrm2;
mach_timespec_t *alarm_time;
spl_t s;
clock = &clock_list[clock_id];
LOCK_CLOCK(s);
alrm1 = (alarm_t) &clock->cl_alarm;
while (alrm2 = alrm1->al_next) {
alarm_time = &alrm2->al_time;
if (CMP_MACH_TIMESPEC(alarm_time, clock_time) > 0)
break;
if (alrm1->al_next = alrm2->al_next)
(alrm1->al_next)->al_prev = alrm1;
if (alrm2->al_status == ALARM_SLEEP) {
alrm2->al_next = 0;
alrm2->al_status = ALARM_DONE;
alrm2->al_time = *clock_time;
thread_wakeup((event_t)alrm2);
}
else {
assert(alrm2->al_status == ALARM_CLOCK);
if (alrm2->al_next = alrmdone)
alrmdone->al_prev = alrm2;
else
thread_call_enter(&alarm_deliver);
alrm2->al_prev = (alarm_t) &alrmdone;
alrmdone = alrm2;
alrm2->al_status = ALARM_DONE;
alrm2->al_time = *clock_time;
}
}
if (alrm2)
(*clock->cl_ops->c_setalrm)(alarm_time);
UNLOCK_CLOCK(s);
}
static void
clock_alarm_deliver(
thread_call_param_t p0,
thread_call_param_t p1)
{
register alarm_t alrm;
kern_return_t code;
spl_t s;
LOCK_CLOCK(s);
while (alrm = alrmdone) {
if (alrmdone = alrm->al_next)
alrmdone->al_prev = (alarm_t) &alrmdone;
UNLOCK_CLOCK(s);
code = (alrm->al_status == ALARM_DONE? KERN_SUCCESS: KERN_ABORTED);
if (alrm->al_port != IP_NULL) {
if (IP_VALID(alrm->al_port)) {
clock_alarm_reply(alrm->al_port, alrm->al_port_type, code,
alrm->al_type, alrm->al_time);
}
LOCK_CLOCK(s);
alrm->al_status = ALARM_FREE;
alrm->al_next = alrmfree;
alrmfree = alrm;
}
else
panic("clock_alarm_deliver");
}
UNLOCK_CLOCK(s);
}
static
void
flush_alarms(
clock_t clock)
{
register alarm_t alrm1, alrm2;
spl_t s;
LOCK_CLOCK(s);
alrm1 = (alarm_t) &clock->cl_alarm;
while (alrm2 = alrm1->al_next) {
if (alrm1->al_next = alrm2->al_next)
(alrm1->al_next)->al_prev = alrm1;
if (alrm2->al_status == ALARM_SLEEP) {
alrm2->al_next = 0;
thread_wakeup((event_t)alrm2);
}
else {
assert(alrm2->al_status == ALARM_CLOCK);
if (alrm2->al_next = alrmdone)
alrmdone->al_prev = alrm2;
else
thread_wakeup((event_t)&alrmdone);
alrm2->al_prev = (alarm_t) &alrmdone;
alrmdone = alrm2;
}
}
UNLOCK_CLOCK(s);
}
static
void
post_alarm(
clock_t clock,
alarm_t alarm)
{
register alarm_t alrm1, alrm2;
mach_timespec_t *alarm_time;
mach_timespec_t *queue_time;
alarm_time = &alarm->al_time;
alrm1 = (alarm_t) &clock->cl_alarm;
while (alrm2 = alrm1->al_next) {
queue_time = &alrm2->al_time;
if (CMP_MACH_TIMESPEC(queue_time, alarm_time) > 0)
break;
alrm1 = alrm2;
}
alrm1->al_next = alarm;
alarm->al_next = alrm2;
alarm->al_prev = alrm1;
if (alrm2)
alrm2->al_prev = alarm;
if (clock->cl_alarm.al_next == alarm)
(*clock->cl_ops->c_setalrm)(alarm_time);
}
static
int
check_time(
alarm_type_t alarm_type,
mach_timespec_t *alarm_time,
mach_timespec_t *clock_time)
{
int result;
if (BAD_ALRMTYPE(alarm_type))
return (-1);
if (BAD_MACH_TIMESPEC(alarm_time))
return (-1);
if ((alarm_type & ALRMTYPE) == TIME_RELATIVE)
ADD_MACH_TIMESPEC(alarm_time, clock_time);
result = CMP_MACH_TIMESPEC(alarm_time, clock_time);
return ((result >= 0)? result: 0);
}
mach_timespec_t
clock_get_system_value(void)
{
clock_t clock = &clock_list[SYSTEM_CLOCK];
mach_timespec_t value;
(void) (*clock->cl_ops->c_gettime)(&value);
return value;
}
mach_timespec_t
clock_get_calendar_value(void)
{
clock_t clock = &clock_list[CALENDAR_CLOCK];
mach_timespec_t value = MACH_TIMESPEC_ZERO;
(void) (*clock->cl_ops->c_gettime)(&value);
return value;
}
void
clock_set_calendar_value(
mach_timespec_t value)
{
clock_t clock = &clock_list[CALENDAR_CLOCK];
(void) (*clock->cl_ops->c_settime)(&value);
}
void
clock_deadline_for_periodic_event(
uint64_t interval,
uint64_t abstime,
uint64_t *deadline)
{
assert(interval != 0);
*deadline += interval;
if (*deadline <= abstime) {
*deadline = abstime;
clock_get_uptime(&abstime);
*deadline += interval;
if (*deadline <= abstime) {
*deadline = abstime;
*deadline += interval;
}
}
}
void
mk_timebase_info(
uint32_t *delta,
uint32_t *abs_to_ns_numer,
uint32_t *abs_to_ns_denom,
uint32_t *proc_to_abs_numer,
uint32_t *proc_to_abs_denom)
{
mach_timebase_info_data_t info;
uint32_t one = 1;
clock_timebase_info(&info);
copyout((void *)&one, (void *)delta, sizeof (uint32_t));
copyout((void *)&info.numer, (void *)abs_to_ns_numer, sizeof (uint32_t));
copyout((void *)&info.denom, (void *)abs_to_ns_denom, sizeof (uint32_t));
copyout((void *)&one, (void *)proc_to_abs_numer, sizeof (uint32_t));
copyout((void *)&one, (void *)proc_to_abs_denom, sizeof (uint32_t));
}
kern_return_t
mach_timebase_info(
mach_timebase_info_t out_info)
{
mach_timebase_info_data_t info;
clock_timebase_info(&info);
copyout((void *)&info, (void *)out_info, sizeof (info));
return (KERN_SUCCESS);
}
kern_return_t
mach_wait_until(
uint64_t deadline)
{
int wait_result;
assert_wait((event_t)&mach_wait_until, THREAD_ABORTSAFE);
thread_set_timer_deadline(deadline);
wait_result = thread_block((void (*)) 0);
if (wait_result != THREAD_TIMED_OUT)
thread_cancel_timer();
return ((wait_result == THREAD_INTERRUPTED)? KERN_ABORTED: KERN_SUCCESS);
}