#include <sys/proc.h>
#include <sys/systm.h>
#include <sys/debug.h>
#include <sys/mutex.h>
#include <sys/atomic.h>
#include <sys/timer.h>
#include <sys/lwp_timer_impl.h>
#include <sys/callo.h>
static void
lwp_timer_timeout(void *arg)
{
lwp_timer_t *lwptp = arg;
kthread_t *t = lwptp->lwpt_thread;
timespec_t now, delta;
mutex_enter(&t->t_delay_lock);
gethrestime(&now);
if (lwptp->lwpt_timecheck == timechanged &&
(lwptp->lwpt_rqtime.tv_sec > now.tv_sec ||
(lwptp->lwpt_rqtime.tv_sec == now.tv_sec &&
lwptp->lwpt_rqtime.tv_nsec > now.tv_nsec))) {
lwptp->lwpt_imm_timeout = 0;
delta = lwptp->lwpt_rqtime;
timespecsub(&delta, &now);
lwptp->lwpt_id = timeout_generic(CALLOUT_REALTIME,
lwp_timer_timeout, lwptp, ts2hrt(&delta), nsec_per_tick,
(CALLOUT_FLAG_HRESTIME | CALLOUT_FLAG_ROUNDUP));
} else {
thread_lock(t);
(void) atomic_cas_uint(&lwptp->lwpt_imm_timeout, 0, 1);
if (t->t_state == TS_SLEEP &&
(t->t_flag & T_WAKEABLE) &&
t->t_wchan0 != NULL)
setrun_locked(t);
thread_unlock(t);
}
mutex_exit(&t->t_delay_lock);
}
int
lwp_timer_copyin(lwp_timer_t *lwptp, timespec_t *tsp)
{
timespec_t now;
int error = 0;
if (tsp == NULL)
goto err;
lwptp->lwpt_timecheck = timechanged;
gethrestime(&now);
if (curproc->p_model == DATAMODEL_NATIVE) {
if (copyin(tsp, &lwptp->lwpt_rqtime, sizeof (timespec_t))) {
error = EFAULT;
goto err;
}
} else {
timespec32_t ts32;
if (copyin(tsp, &ts32, sizeof (timespec32_t))) {
error = EFAULT;
goto err;
}
TIMESPEC32_TO_TIMESPEC(&lwptp->lwpt_rqtime, &ts32);
}
if (itimerspecfix(&lwptp->lwpt_rqtime)) {
error = EINVAL;
goto err;
}
if (lwptp->lwpt_rqtime.tv_sec == 0 && lwptp->lwpt_rqtime.tv_nsec == 0) {
bzero(lwptp, sizeof (lwp_timer_t));
lwptp->lwpt_imm_timeout = 1;
} else {
lwptp->lwpt_thread = curthread;
lwptp->lwpt_tsp = tsp;
lwptp->lwpt_time_error = 0;
lwptp->lwpt_id = 0;
lwptp->lwpt_imm_timeout = 0;
timespecadd(&lwptp->lwpt_rqtime, &now);
}
return (0);
err:
bzero(lwptp, sizeof (lwp_timer_t));
lwptp->lwpt_time_error = error;
return (error);
}
int
lwp_timer_enqueue(lwp_timer_t *lwptp)
{
timespec_t now, delta;
ASSERT(lwptp->lwpt_thread == curthread);
ASSERT(MUTEX_HELD(&curthread->t_delay_lock));
gethrestime(&now);
if (lwptp->lwpt_timecheck == timechanged &&
(lwptp->lwpt_rqtime.tv_sec > now.tv_sec ||
(lwptp->lwpt_rqtime.tv_sec == now.tv_sec &&
lwptp->lwpt_rqtime.tv_nsec > now.tv_nsec))) {
lwptp->lwpt_imm_timeout = 0;
delta = lwptp->lwpt_rqtime;
timespecsub(&delta, &now);
lwptp->lwpt_id = timeout_generic(CALLOUT_REALTIME,
lwp_timer_timeout, lwptp, ts2hrt(&delta), nsec_per_tick,
(CALLOUT_FLAG_HRESTIME | CALLOUT_FLAG_ROUNDUP));
return (0);
}
lwptp->lwpt_imm_timeout = 1;
return (1);
}
clock_t
lwp_timer_dequeue(lwp_timer_t *lwptp)
{
kthread_t *t = curthread;
clock_t tim = -1;
callout_id_t tmp_id;
mutex_enter(&t->t_delay_lock);
while ((tmp_id = lwptp->lwpt_id) != 0) {
lwptp->lwpt_id = 0;
mutex_exit(&t->t_delay_lock);
tim = untimeout_default(tmp_id, 0);
mutex_enter(&t->t_delay_lock);
}
mutex_exit(&t->t_delay_lock);
return (tim);
}
int
lwp_timer_copyout(lwp_timer_t *lwptp, int error)
{
timespec_t rmtime;
timespec_t now;
if (lwptp->lwpt_tsp == NULL)
return (error);
rmtime.tv_sec = rmtime.tv_nsec = 0;
if (error != ETIME) {
gethrestime(&now);
if ((now.tv_sec < lwptp->lwpt_rqtime.tv_sec) ||
((now.tv_sec == lwptp->lwpt_rqtime.tv_sec) &&
(now.tv_nsec < lwptp->lwpt_rqtime.tv_nsec))) {
rmtime = lwptp->lwpt_rqtime;
timespecsub(&rmtime, &now);
}
}
if (curproc->p_model == DATAMODEL_NATIVE) {
if (copyout(&rmtime, lwptp->lwpt_tsp, sizeof (timespec_t)))
error = EFAULT;
} else {
timespec32_t rmtime32;
TIMESPEC_TO_TIMESPEC32(&rmtime32, &rmtime);
if (copyout(&rmtime32, lwptp->lwpt_tsp, sizeof (timespec32_t)))
error = EFAULT;
}
return (error);
}