#include <sys/thread.h>
#include <sys/proc.h>
#include <sys/debug.h>
#include <sys/cmn_err.h>
#include <sys/systm.h>
#include <sys/sobject.h>
#include <sys/sleepq.h>
#include <sys/cpuvar.h>
#include <sys/condvar.h>
#include <sys/condvar_impl.h>
#include <sys/schedctl.h>
#include <sys/procfs.h>
#include <sys/sdt.h>
#include <sys/callo.h>
#define CV_MAX_WAITERS 1024
#define CV_WAITERS_MASK (CV_MAX_WAITERS - 1)
static kthread_t *
cv_owner(void *cvp)
{
return (NULL);
}
static void
cv_unsleep(kthread_t *t)
{
condvar_impl_t *cvp = (condvar_impl_t *)t->t_wchan;
sleepq_head_t *sqh = SQHASH(cvp);
ASSERT(THREAD_LOCK_HELD(t));
if (cvp == NULL)
panic("cv_unsleep: thread %p not on sleepq %p",
(void *)t, (void *)sqh);
DTRACE_SCHED1(wakeup, kthread_t *, t);
sleepq_unsleep(t);
if (cvp->cv_waiters != CV_MAX_WAITERS)
cvp->cv_waiters--;
disp_lock_exit_high(&sqh->sq_lock);
CL_SETRUN(t);
}
static void
cv_change_pri(kthread_t *t, pri_t pri, pri_t *t_prip)
{
condvar_impl_t *cvp = (condvar_impl_t *)t->t_wchan;
sleepq_t *sqp = t->t_sleepq;
ASSERT(THREAD_LOCK_HELD(t));
ASSERT(&SQHASH(cvp)->sq_queue == sqp);
if (cvp == NULL)
panic("cv_change_pri: %p not on sleep queue", (void *)t);
sleepq_dequeue(t);
*t_prip = pri;
sleepq_insert(sqp, t);
}
static sobj_ops_t cv_sobj_ops = {
SOBJ_CV, cv_owner, cv_unsleep, cv_change_pri
};
void
cv_init(kcondvar_t *cvp, char *name, kcv_type_t type, void *arg)
{
((condvar_impl_t *)cvp)->cv_waiters = 0;
}
void
cv_destroy(kcondvar_t *cvp)
{
ASSERT((((condvar_impl_t *)cvp)->cv_waiters & CV_WAITERS_MASK) == 0);
}
static void
cv_block(condvar_impl_t *cvp)
{
kthread_t *t = curthread;
klwp_t *lwp = ttolwp(t);
sleepq_head_t *sqh;
ASSERT(THREAD_LOCK_HELD(t));
ASSERT(t != CPU->cpu_idle_thread);
ASSERT(CPU_ON_INTR(CPU) == 0);
ASSERT(t->t_wchan0 == NULL && t->t_wchan == NULL);
ASSERT(t->t_state == TS_ONPROC);
t->t_schedflag &= ~TS_SIGNALLED;
CL_SLEEP(t);
t->t_wchan = (caddr_t)cvp;
t->t_sobj_ops = &cv_sobj_ops;
DTRACE_SCHED(sleep);
if (lwp != NULL && t->t_intr == NULL) {
lwp->lwp_ru.nvcsw++;
(void) new_mstate(t, LMS_SLEEP);
}
sqh = SQHASH(cvp);
disp_lock_enter_high(&sqh->sq_lock);
if (cvp->cv_waiters < CV_MAX_WAITERS)
cvp->cv_waiters++;
ASSERT(cvp->cv_waiters <= CV_MAX_WAITERS);
THREAD_SLEEP(t, &sqh->sq_lock);
sleepq_insert(&sqh->sq_queue, t);
}
#define cv_block_sig(t, cvp) \
{ (t)->t_flag |= T_WAKEABLE; cv_block(cvp); }
void
cv_wait(kcondvar_t *cvp, kmutex_t *mp)
{
if (panicstr)
return;
ASSERT(!quiesce_active);
ASSERT(curthread->t_schedflag & TS_DONT_SWAP);
thread_lock(curthread);
cv_block((condvar_impl_t *)cvp);
thread_unlock_nopreempt(curthread);
mutex_exit(mp);
swtch();
mutex_enter(mp);
}
static void
cv_wakeup(void *arg)
{
kthread_t *t = arg;
mutex_enter(&t->t_wait_mutex);
mutex_exit(&t->t_wait_mutex);
setrun(t);
}
clock_t
cv_timedwait(kcondvar_t *cvp, kmutex_t *mp, clock_t tim)
{
hrtime_t hrtim;
clock_t now = ddi_get_lbolt();
if (tim <= now)
return (-1);
hrtim = TICK_TO_NSEC(tim - now);
return (cv_timedwait_hires(cvp, mp, hrtim, nsec_per_tick, 0));
}
clock_t
cv_reltimedwait(kcondvar_t *cvp, kmutex_t *mp, clock_t delta, time_res_t res)
{
hrtime_t exp;
ASSERT(TIME_RES_VALID(res));
if (delta <= 0)
return (-1);
if ((exp = TICK_TO_NSEC(delta)) < 0)
exp = CY_INFINITY;
return (cv_timedwait_hires(cvp, mp, exp, time_res[res], 0));
}
clock_t
cv_timedwait_hires(kcondvar_t *cvp, kmutex_t *mp, hrtime_t tim,
hrtime_t res, int flag)
{
kthread_t *t = curthread;
callout_id_t id;
clock_t timeleft;
hrtime_t limit;
int signalled;
if (panicstr)
return (-1);
ASSERT(!quiesce_active);
limit = (flag & CALLOUT_FLAG_ABSOLUTE) ? gethrtime() : 0;
if (tim <= limit)
return (-1);
mutex_enter(&t->t_wait_mutex);
id = timeout_generic(CALLOUT_REALTIME, (void (*)(void *))cv_wakeup, t,
tim, res, flag);
thread_lock(t);
cv_block((condvar_impl_t *)cvp);
thread_unlock_nopreempt(t);
mutex_exit(&t->t_wait_mutex);
mutex_exit(mp);
swtch();
signalled = (t->t_schedflag & TS_SIGNALLED);
timeleft = untimeout_default(id, 0);
mutex_enter(mp);
if (timeleft <= 0) {
timeleft = -1;
if (signalled)
cv_signal(cvp);
}
return (timeleft);
}
int
cv_wait_sig(kcondvar_t *cvp, kmutex_t *mp)
{
kthread_t *t = curthread;
proc_t *p = ttoproc(t);
klwp_t *lwp = ttolwp(t);
int cancel_pending;
int rval = 1;
int signalled = 0;
if (panicstr)
return (rval);
ASSERT(!quiesce_active);
if (lwp == NULL || (p->p_flag & SSYS)) {
cv_wait(cvp, mp);
return (rval);
}
ASSERT(t->t_intr == NULL);
ASSERT(curthread->t_schedflag & TS_DONT_SWAP);
cancel_pending = schedctl_cancel_pending();
lwp->lwp_asleep = 1;
lwp->lwp_sysabort = 0;
thread_lock(t);
cv_block_sig(t, (condvar_impl_t *)cvp);
thread_unlock_nopreempt(t);
mutex_exit(mp);
if (ISSIG(t, JUSTLOOKING) || MUSTRETURN(p, t) || cancel_pending)
setrun(t);
swtch();
signalled = (t->t_schedflag & TS_SIGNALLED);
t->t_flag &= ~T_WAKEABLE;
mutex_enter(mp);
if (ISSIG_PENDING(t, lwp, p)) {
mutex_exit(mp);
if (issig(FORREAL))
rval = 0;
mutex_enter(mp);
}
if (lwp->lwp_sysabort || MUSTRETURN(p, t))
rval = 0;
if (rval != 0 && cancel_pending) {
schedctl_cancel_eintr();
rval = 0;
}
lwp->lwp_asleep = 0;
lwp->lwp_sysabort = 0;
if (rval == 0 && signalled)
cv_signal(cvp);
return (rval);
}
static clock_t
cv_timedwait_sig_hires(kcondvar_t *cvp, kmutex_t *mp, hrtime_t tim,
hrtime_t res, int flag)
{
kthread_t *t = curthread;
proc_t *p = ttoproc(t);
klwp_t *lwp = ttolwp(t);
int cancel_pending = 0;
callout_id_t id;
clock_t rval = 1;
hrtime_t limit;
int signalled = 0;
if (panicstr)
return (rval);
ASSERT(!quiesce_active);
if (lwp == NULL || (p->p_flag & SSYS))
return (cv_timedwait_hires(cvp, mp, tim, res, flag));
ASSERT(t->t_intr == NULL);
limit = (flag & CALLOUT_FLAG_ABSOLUTE) ? gethrtime() : 0;
if (tim <= limit) {
lwp->lwp_asleep = 1;
lwp->lwp_sysabort = 0;
rval = -1;
goto out;
}
cancel_pending = schedctl_cancel_pending();
mutex_enter(&t->t_wait_mutex);
id = timeout_generic(CALLOUT_REALTIME, (void (*)(void *))cv_wakeup, t,
tim, res, flag);
lwp->lwp_asleep = 1;
lwp->lwp_sysabort = 0;
thread_lock(t);
cv_block_sig(t, (condvar_impl_t *)cvp);
thread_unlock_nopreempt(t);
mutex_exit(&t->t_wait_mutex);
mutex_exit(mp);
if (ISSIG(t, JUSTLOOKING) || MUSTRETURN(p, t) || cancel_pending)
setrun(t);
swtch();
signalled = (t->t_schedflag & TS_SIGNALLED);
t->t_flag &= ~T_WAKEABLE;
rval = untimeout_default(id, 0);
mutex_enter(mp);
if (rval <= 0)
rval = -1;
out:
if (ISSIG_PENDING(t, lwp, p)) {
mutex_exit(mp);
if (issig(FORREAL))
rval = 0;
mutex_enter(mp);
}
if (lwp->lwp_sysabort || MUSTRETURN(p, t))
rval = 0;
if (rval != 0 && cancel_pending) {
schedctl_cancel_eintr();
rval = 0;
}
lwp->lwp_asleep = 0;
lwp->lwp_sysabort = 0;
if (rval <= 0 && signalled)
cv_signal(cvp);
return (rval);
}
clock_t
cv_timedwait_sig(kcondvar_t *cvp, kmutex_t *mp, clock_t tim)
{
hrtime_t hrtim;
hrtim = TICK_TO_NSEC(tim - ddi_get_lbolt());
return (cv_timedwait_sig_hires(cvp, mp, hrtim, nsec_per_tick, 0));
}
int
cv_timedwait_sig_hrtime(kcondvar_t *cvp, kmutex_t *mp, hrtime_t tim)
{
if (tim == -1) {
return (cv_wait_sig_swap(cvp, mp));
} else {
return (cv_timedwait_sig_hires(cvp, mp, tim, 1,
CALLOUT_FLAG_ABSOLUTE | CALLOUT_FLAG_ROUNDUP));
}
}
clock_t
cv_reltimedwait_sig(kcondvar_t *cvp, kmutex_t *mp, clock_t delta,
time_res_t res)
{
hrtime_t exp = 0;
ASSERT(TIME_RES_VALID(res));
if (delta > 0) {
if ((exp = TICK_TO_NSEC(delta)) < 0)
exp = CY_INFINITY;
}
return (cv_timedwait_sig_hires(cvp, mp, exp, time_res[res], 0));
}
int
cv_wait_sig_swap_core(kcondvar_t *cvp, kmutex_t *mp, int *sigret)
{
kthread_t *t = curthread;
proc_t *p = ttoproc(t);
klwp_t *lwp = ttolwp(t);
int cancel_pending;
int rval = 1;
int signalled = 0;
if (panicstr)
return (rval);
if (lwp == NULL || (p->p_flag & SSYS)) {
cv_wait(cvp, mp);
return (rval);
}
ASSERT(t->t_intr == NULL);
cancel_pending = schedctl_cancel_pending();
lwp->lwp_asleep = 1;
lwp->lwp_sysabort = 0;
thread_lock(t);
cv_block_sig(t, (condvar_impl_t *)cvp);
curthread->t_schedflag &= ~TS_DONT_SWAP;
thread_unlock_nopreempt(t);
mutex_exit(mp);
if (ISSIG(t, JUSTLOOKING) || MUSTRETURN(p, t) || cancel_pending)
setrun(t);
swtch();
signalled = (t->t_schedflag & TS_SIGNALLED);
t->t_flag &= ~T_WAKEABLE;
ASSERT(curthread->t_schedflag & TS_DONT_SWAP);
mutex_enter(mp);
if (ISSIG_PENDING(t, lwp, p)) {
mutex_exit(mp);
if (issig(FORREAL))
rval = 0;
mutex_enter(mp);
}
if (lwp->lwp_sysabort || MUSTRETURN(p, t))
rval = 0;
if (rval != 0 && cancel_pending) {
schedctl_cancel_eintr();
rval = 0;
}
lwp->lwp_asleep = 0;
lwp->lwp_sysabort = 0;
if (rval == 0) {
if (sigret != NULL)
*sigret = signalled;
else if (signalled)
cv_signal(cvp);
}
return (rval);
}
int
cv_wait_sig_swap(kcondvar_t *cvp, kmutex_t *mp)
{
return (cv_wait_sig_swap_core(cvp, mp, NULL));
}
void
cv_signal(kcondvar_t *cvp)
{
condvar_impl_t *cp = (condvar_impl_t *)cvp;
ASSERT(cp->cv_waiters <= CV_MAX_WAITERS);
if (cp->cv_waiters > 0) {
sleepq_head_t *sqh = SQHASH(cp);
disp_lock_enter(&sqh->sq_lock);
ASSERT(CPU_ON_INTR(CPU) == 0);
if (cp->cv_waiters & CV_WAITERS_MASK) {
kthread_t *t;
cp->cv_waiters--;
t = sleepq_wakeone_chan(&sqh->sq_queue, cp);
ASSERT(t != NULL);
} else if (sleepq_wakeone_chan(&sqh->sq_queue, cp) == NULL) {
cp->cv_waiters = 0;
}
disp_lock_exit(&sqh->sq_lock);
}
}
void
cv_broadcast(kcondvar_t *cvp)
{
condvar_impl_t *cp = (condvar_impl_t *)cvp;
ASSERT(cp->cv_waiters <= CV_MAX_WAITERS);
if (cp->cv_waiters > 0) {
sleepq_head_t *sqh = SQHASH(cp);
disp_lock_enter(&sqh->sq_lock);
ASSERT(CPU_ON_INTR(CPU) == 0);
sleepq_wakeall_chan(&sqh->sq_queue, cp);
cp->cv_waiters = 0;
disp_lock_exit(&sqh->sq_lock);
}
}
void
cv_wait_stop(kcondvar_t *cvp, kmutex_t *mp, int wakeup_time)
{
kthread_t *t = curthread;
klwp_t *lwp = ttolwp(t);
proc_t *p = ttoproc(t);
callout_id_t id;
clock_t tim;
if (panicstr)
return;
if (lwp == NULL || (p->p_flag & SSYS)) {
cv_wait(cvp, mp);
return;
}
ASSERT(t->t_intr == NULL);
tim = ddi_get_lbolt() + MSEC_TO_TICK(wakeup_time);
mutex_enter(&t->t_wait_mutex);
id = realtime_timeout_default((void (*)(void *))cv_wakeup, t,
tim - ddi_get_lbolt());
thread_lock(t);
cv_block((condvar_impl_t *)cvp);
thread_unlock_nopreempt(t);
mutex_exit(&t->t_wait_mutex);
mutex_exit(mp);
swtch();
(void) untimeout_default(id, 0);
mutex_enter(&p->p_lock);
while (lwp->lwp_nostop == 0 && !(p->p_flag & SEXITLWPS)) {
if (t->t_proc_flag & TP_PAUSE) {
stop(PR_SUSPENDED, SUSPEND_PAUSE);
continue;
}
if (t->t_proc_flag & TP_CHKPT) {
stop(PR_CHECKPOINT, 0);
continue;
}
if ((p->p_flag & (SHOLDFORK1|SHOLDWATCH)) ||
(t->t_proc_flag & TP_HOLDLWP)) {
stop(PR_SUSPENDED, SUSPEND_NORMAL);
continue;
}
if (t->t_proc_flag & TP_PRSTOP) {
stop(PR_REQUESTED, 0);
}
if (p->p_stopsig && t != p->p_agenttp) {
stop(PR_JOBCONTROL, p->p_stopsig);
continue;
}
break;
}
mutex_exit(&p->p_lock);
mutex_enter(mp);
}
int
cv_waituntil_sig(kcondvar_t *cvp, kmutex_t *mp, timestruc_t *when,
int timecheck)
{
timestruc_t now;
timestruc_t delta;
hrtime_t interval;
int rval;
if (when == NULL)
return (cv_wait_sig_swap(cvp, mp));
gethrestime(&now);
delta = *when;
timespecsub(&delta, &now);
if (delta.tv_sec < 0 || (delta.tv_sec == 0 && delta.tv_nsec == 0)) {
rval = cv_timedwait_sig_hires(cvp, mp, 0, 1, 0);
} else {
if (timecheck == timechanged) {
interval = ts2hrt(&delta);
if (interval < nsec_per_tick)
interval = nsec_per_tick;
rval = cv_timedwait_sig_hires(cvp, mp, interval, 1,
CALLOUT_FLAG_HRESTIME);
} else {
rval = -1;
}
if (rval == -1 && timecheck == timechanged) {
gethrestime(&now);
delta = *when;
timespecsub(&delta, &now);
if (delta.tv_sec > 0 || (delta.tv_sec == 0 &&
delta.tv_nsec > 0))
rval = 1;
}
}
return (rval);
}