+/* calculations for digital decay to forget 90% of usage in 5*loadav sec */
+#define get_b(loadav) (2 * (loadav))
+#define get_pcpu(b, cpu) (((b) * ((cpu) & 0377)) / ((b) + FSCALE))
+
+/* decay 95% of `p_pctcpu' in 60 seconds; see CCPU_SHIFT before changing */
+fixpt_t ccpu = 0.95122942450071400909 * FSCALE; /* exp(-1/20) */
+
+/*
+ * If `ccpu' is not equal to `exp(-1/20)' and you still want to use the
+ * faster/more-accurate formula, you'll have to estimate CCPU_SHIFT below
+ * and possibly adjust FSHIFT in "param.h" so that (FSHIFT >= CCPU_SHIFT).
+ *
+ * To estimate CCPU_SHIFT for exp(-1/20), the following formula was used:
+ * 1 - exp(-1/20) ~= 0.0487 ~= 0.0488 == 1 (fixed pt, *11* bits).
+ *
+ * If you dont want to bother with the faster/more-accurate formula, you
+ * can set CCPU_SHIFT to (FSHIFT + 1) which will use a slower/less-accurate
+ * (more general) method of calculating the %age of CPU used by a process.
+ */
+#define CCPU_SHIFT 11
+
+/*
+ * Recompute process priorities, once a second
+ */
+schedcpu()
+{
+ register fixpt_t b = get_b(averunnable[0]);
+ register struct proc *p;
+ register int s, a;
+
+ wakeup((caddr_t)&lbolt);
+ for (p = allproc; p != NULL; p = p->p_nxt) {
+ if (p->p_time != 127)
+ p->p_time++;
+ if (p->p_stat==SSLEEP || p->p_stat==SSTOP)
+ if (p->p_slptime != 127)
+ p->p_slptime++;
+ p->p_pctcpu = (p->p_pctcpu * ccpu) >> FSHIFT;
+ /*
+ * If the process has slept the entire second,
+ * stop recalculating its priority until it wakes up.
+ */
+ if (p->p_slptime > 1)
+ continue;
+ /*
+ * p_pctcpu is only for ps.
+ */
+#if (FSHIFT >= CCPU_SHIFT)
+ p->p_pctcpu += (hz == 100)?
+ ((fixpt_t) p->p_cpticks) << (FSHIFT - CCPU_SHIFT):
+ 100 * (((fixpt_t) p->p_cpticks)
+ << (FSHIFT - CCPU_SHIFT)) / hz;
+#else
+ p->p_pctcpu += ((FSCALE - ccpu) *
+ (p->p_cpticks * FSCALE / hz)) >> FSHIFT;
+#endif
+ p->p_cpticks = 0;
+ a = (int) get_pcpu(b, p->p_cpu) + p->p_nice;
+ if (a < 0)
+ a = 0;
+ if (a > 255)
+ a = 255;
+ p->p_cpu = a;
+ (void) setpri(p);
+ s = splhigh(); /* prevent state changes */
+ if (p->p_pri >= PUSER) {
+#define PPQ (128 / NQS)
+ if ((p != u.u_procp || noproc) &&
+ p->p_stat == SRUN &&
+ (p->p_flag & SLOAD) &&
+ (p->p_pri / PPQ) != (p->p_usrpri / PPQ)) {
+ remrq(p);
+ p->p_pri = p->p_usrpri;
+ setrq(p);
+ } else
+ p->p_pri = p->p_usrpri;
+ }
+ splx(s);
+ }
+ vmmeter();
+ if (runin!=0) {
+ runin = 0;
+ wakeup((caddr_t)&runin);
+ }
+ if (bclnlist != NULL)
+ wakeup((caddr_t)&proc[2]);
+ timeout(schedcpu, (caddr_t)0, hz);
+}
+
+/*
+ * Recalculate the priority of a process after it has slept for a while.
+ */
+updatepri(p)
+ register struct proc *p;
+{
+ register int a = p->p_cpu & 0377;
+ register fixpt_t b = get_b(averunnable[0]);
+
+ p->p_slptime--; /* the first time was done in schedcpu */
+ while (a && --p->p_slptime)
+ a = (int) get_pcpu(b, a) /* + p->p_nice */;
+ p->p_slptime = 0;
+ if (a < 0)
+ a = 0;
+ if (a > 255)
+ a = 255;
+ p->p_cpu = a;
+ (void) setpri(p);
+}