]> git.saurik.com Git - apple/xnu.git/blobdiff - osfmk/kern/sched_prim.c
xnu-3789.21.4.tar.gz
[apple/xnu.git] / osfmk / kern / sched_prim.c
index 3a88e11fb4fcf2d25f9ea6eefe81b6314aa3731f..2b2a98d68ff03b5ce00aa21fcbbcb4c2f0e2c3b6 100644 (file)
@@ -1,5 +1,5 @@
 /*
- * Copyright (c) 2000-2012 Apple Inc. All rights reserved.
+ * Copyright (c) 2000-2016 Apple Inc. All rights reserved.
  *
  * @APPLE_OSREFERENCE_LICENSE_HEADER_START@
  * 
 #endif
 
 #include <kern/kern_types.h>
+#include <kern/backtrace.h>
 #include <kern/clock.h>
 #include <kern/counters.h>
 #include <kern/cpu_number.h>
 #include <kern/cpu_data.h>
+#include <kern/smp.h>
 #include <kern/debug.h>
 #include <kern/macro_help.h>
 #include <kern/machine.h>
 #include <kern/syscall_subr.h>
 #include <kern/task.h>
 #include <kern/thread.h>
-#include <kern/wait_queue.h>
 #include <kern/ledger.h>
 #include <kern/timer_queue.h>
+#include <kern/waitq.h>
+#include <kern/policy_internal.h>
 
 #include <vm/pmap.h>
 #include <vm/vm_kern.h>
 #include <mach/sdt.h>
 
 #include <sys/kdebug.h>
+#include <kperf/kperf.h>
+#include <kern/kpc.h>
 
 #include <kern/pms.h>
 
-#if defined(CONFIG_TELEMETRY) && defined(CONFIG_SCHED_TIMESHARE_CORE)
-#include <kern/telemetry.h>
-#endif
-
 struct rt_queue        rt_runq;
-#define RT_RUNQ                ((processor_t)-1)
-decl_simple_lock_data(static,rt_lock);
 
-#if defined(CONFIG_SCHED_FAIRSHARE_CORE)
-static struct fairshare_queue  fs_runq;
-#define FS_RUNQ                ((processor_t)-2)
-decl_simple_lock_data(static,fs_lock);
-#endif /* CONFIG_SCHED_FAIRSHARE_CORE */
+uintptr_t sched_thread_on_rt_queue = (uintptr_t)0xDEAFBEE0;
+
+/* Lock RT runq, must be done with interrupts disabled (under splsched()) */
+#if __SMP__
+decl_simple_lock_data(static,rt_lock);
+#define rt_lock_init()         simple_lock_init(&rt_lock, 0)
+#define rt_lock_lock()         simple_lock(&rt_lock)
+#define rt_lock_unlock()       simple_unlock(&rt_lock)
+#else
+#define rt_lock_init()         do { } while(0)
+#define rt_lock_lock()         do { } while(0)
+#define rt_lock_unlock()       do { } while(0)
+#endif
 
 #define                DEFAULT_PREEMPTION_RATE         100             /* (1/s) */
 int                    default_preemption_rate = DEFAULT_PREEMPTION_RATE;
@@ -168,15 +175,9 @@ uint32_t   min_rt_quantum;
 
 unsigned       sched_tick;
 uint32_t       sched_tick_interval;
-#if defined(CONFIG_TELEMETRY)
-uint32_t       sched_telemetry_interval;
-#endif /* CONFIG_TELEMETRY */
 
-uint32_t       sched_pri_shift = INT8_MAX;
-uint32_t       sched_background_pri_shift = INT8_MAX;
-uint32_t       sched_combined_fgbg_pri_shift = INT8_MAX;
+uint32_t       sched_pri_shifts[TH_BUCKET_MAX];
 uint32_t       sched_fixed_shift;
-uint32_t       sched_use_combined_fgbg_decay = 0;
 
 uint32_t       sched_decay_usage_age_factor = 1; /* accelerate 5/8^n usage aging */
 
@@ -193,58 +194,13 @@ int               sched_pri_decay_band_limit = DEFAULT_DECAY_BAND_LIMIT;
 uint64_t timer_deadline_tracking_bin_1;
 uint64_t timer_deadline_tracking_bin_2;
 
-thread_t sched_maintenance_thread;
-
 #endif /* CONFIG_SCHED_TIMESHARE_CORE */
 
-#if defined(CONFIG_SCHED_TRADITIONAL)
-
-static boolean_t sched_traditional_use_pset_runqueue = FALSE;
-
-__attribute__((always_inline))
-static inline run_queue_t runq_for_processor(processor_t processor)
-{
-       if (sched_traditional_use_pset_runqueue)
-               return &processor->processor_set->pset_runq;
-       else
-               return &processor->runq;
-}
-
-__attribute__((always_inline))
-static inline void runq_consider_incr_bound_count(processor_t processor, thread_t thread)
-{
-       if (thread->bound_processor == PROCESSOR_NULL)
-               return;
-    
-       assert(thread->bound_processor == processor);
-    
-       if (sched_traditional_use_pset_runqueue)
-               processor->processor_set->pset_runq_bound_count++;
-    
-       processor->runq_bound_count++;
-}
-
-__attribute__((always_inline))
-static inline void runq_consider_decr_bound_count(processor_t processor, thread_t thread)
-{
-       if (thread->bound_processor == PROCESSOR_NULL)
-               return;
-    
-       assert(thread->bound_processor == processor);
-    
-       if (sched_traditional_use_pset_runqueue)
-               processor->processor_set->pset_runq_bound_count--;
-    
-       processor->runq_bound_count--;
-}
+thread_t sched_maintenance_thread;
 
-#endif /* CONFIG_SCHED_TRADITIONAL */
 
 uint64_t       sched_one_second_interval;
 
-uint32_t       sched_run_count, sched_share_count, sched_background_count;
-uint32_t       sched_load_average, sched_mach_factor;
-
 /* Forwards */
 
 #if defined(CONFIG_SCHED_TIMESHARE_CORE)
@@ -274,72 +230,11 @@ csw_check_locked( processor_t             processor,
                                        processor_set_t pset,
                                        ast_t                   check_reason);
 
-#if defined(CONFIG_SCHED_TRADITIONAL)
-
-static thread_t        steal_thread(
-                                       processor_set_t         pset);
-
-static thread_t        steal_thread_disabled(
-                                       processor_set_t         pset) __attribute__((unused));
-
-
-static thread_t        steal_processor_thread(
-                                       processor_t                     processor);
-
-static void            thread_update_scan(void);
-
 static void processor_setrun(
                                 processor_t                    processor,
                                 thread_t                       thread,
                                 integer_t                      options);
 
-static boolean_t
-processor_enqueue(
-                                 processor_t           processor,
-                                 thread_t              thread,
-                                 integer_t             options);
-
-static boolean_t
-processor_queue_remove(
-                                          processor_t                  processor,
-                                          thread_t             thread);
-
-static boolean_t       processor_queue_empty(processor_t               processor);
-
-static ast_t           processor_csw_check(processor_t processor);
-
-static boolean_t       processor_queue_has_priority(processor_t                processor,
-                                                                                       int                             priority,
-                                                                                       boolean_t               gte);
-
-static boolean_t       should_current_thread_rechoose_processor(processor_t                    processor);
-
-static int     sched_traditional_processor_runq_count(processor_t   processor);
-
-static boolean_t       sched_traditional_with_pset_runqueue_processor_queue_empty(processor_t          processor);
-
-static uint64_t     sched_traditional_processor_runq_stats_count_sum(processor_t   processor);
-
-static uint64_t                sched_traditional_with_pset_runqueue_processor_runq_stats_count_sum(processor_t   processor);
-
-static int      sched_traditional_processor_bound_count(processor_t processor);
-
-#endif
-
-
-#if defined(CONFIG_SCHED_TRADITIONAL)
-
-static void
-sched_traditional_processor_init(processor_t processor);
-
-static void
-sched_traditional_pset_init(processor_set_t pset);
-
-static void
-sched_traditional_with_pset_runqueue_init(void);
-
-#endif
-
 static void
 sched_realtime_init(void);
 
@@ -349,19 +244,6 @@ sched_realtime_timebase_init(void);
 static void
 sched_timer_deadline_tracking_init(void);
 
-#if defined(CONFIG_SCHED_TRADITIONAL)
-
-static sched_mode_t
-sched_traditional_initial_thread_sched_mode(task_t parent_task);
-
-static thread_t
-sched_traditional_choose_thread(
-                                processor_t     processor,
-                                int             priority,
-                       __unused ast_t           reason);
-
-#endif
-
 #if    DEBUG
 extern int debug_task;
 #define TLOG(a, fmt, args...) if(debug_task & a) kprintf(fmt, ## args)
@@ -369,120 +251,19 @@ extern int debug_task;
 #define TLOG(a, fmt, args...) do {} while (0)
 #endif
 
-__assert_only static
-boolean_t      thread_runnable(
-                               thread_t                thread);
+static processor_t
+thread_bind_internal(
+       thread_t                thread,
+       processor_t             processor);
 
-/*
- *     State machine
- *
- * states are combinations of:
- *  R  running
- *  W  waiting (or on wait queue)
- *  N  non-interruptible
- *  O  swapped out
- *  I  being swapped in
- *
- * init        action 
- *     assert_wait thread_block    clear_wait          swapout swapin
- *
- * R   RW, RWN     R;   setrun     -                   -
- * RN  RWN         RN;  setrun     -                   -
- *
- * RW              W               R                   -
- * RWN             WN              RN                  -
- *
- * W                               R;   setrun         WO
- * WN                              RN;  setrun         -
- *
- * RO                              -                   -       R
- *
- */
+static void
+sched_vm_group_maintenance(void);
 
 #if defined(CONFIG_SCHED_TIMESHARE_CORE)
 int8_t         sched_load_shifts[NRQS];
-int            sched_preempt_pri[NRQBM];
+bitmap_t       sched_preempt_pri[BITMAP_LEN(NRQS)];
 #endif /* CONFIG_SCHED_TIMESHARE_CORE */
 
-
-#if defined(CONFIG_SCHED_TRADITIONAL)
-
-const struct sched_dispatch_table sched_traditional_dispatch = {
-       .init                                           = sched_traditional_init,
-       .timebase_init                                  = sched_traditional_timebase_init,
-       .processor_init                                 = sched_traditional_processor_init,
-       .pset_init                                      = sched_traditional_pset_init,
-       .maintenance_continuation                       = sched_traditional_maintenance_continue,
-       .choose_thread                                  = sched_traditional_choose_thread,
-       .steal_thread                                   = steal_thread,
-       .compute_priority                               = compute_priority,
-       .choose_processor                               = choose_processor,
-       .processor_enqueue                              = processor_enqueue,
-       .processor_queue_shutdown                       = processor_queue_shutdown,
-       .processor_queue_remove                         = processor_queue_remove,
-       .processor_queue_empty                          = processor_queue_empty,
-       .priority_is_urgent                             = priority_is_urgent,
-       .processor_csw_check                            = processor_csw_check,
-       .processor_queue_has_priority                   = processor_queue_has_priority,
-       .initial_quantum_size                           = sched_traditional_initial_quantum_size,
-       .initial_thread_sched_mode                      = sched_traditional_initial_thread_sched_mode,
-       .can_update_priority                            = can_update_priority,
-       .update_priority                                = update_priority,
-       .lightweight_update_priority                    = lightweight_update_priority,
-       .quantum_expire                                 = sched_traditional_quantum_expire,
-       .should_current_thread_rechoose_processor       = should_current_thread_rechoose_processor,
-       .processor_runq_count                           = sched_traditional_processor_runq_count,
-       .processor_runq_stats_count_sum                 = sched_traditional_processor_runq_stats_count_sum,
-       .fairshare_init                                 = sched_traditional_fairshare_init,
-       .fairshare_runq_count                           = sched_traditional_fairshare_runq_count,
-       .fairshare_runq_stats_count_sum                 = sched_traditional_fairshare_runq_stats_count_sum,
-       .fairshare_enqueue                              = sched_traditional_fairshare_enqueue,
-       .fairshare_dequeue                              = sched_traditional_fairshare_dequeue,
-       .fairshare_queue_remove                         = sched_traditional_fairshare_queue_remove,
-       .processor_bound_count                          = sched_traditional_processor_bound_count,
-       .thread_update_scan                             = thread_update_scan,
-       .direct_dispatch_to_idle_processors             = TRUE,
-};
-
-const struct sched_dispatch_table sched_traditional_with_pset_runqueue_dispatch = {
-       .init                                           = sched_traditional_with_pset_runqueue_init,
-       .timebase_init                                  = sched_traditional_timebase_init,
-       .processor_init                                 = sched_traditional_processor_init,
-       .pset_init                                      = sched_traditional_pset_init,
-       .maintenance_continuation                       = sched_traditional_maintenance_continue,
-       .choose_thread                                  = sched_traditional_choose_thread,
-       .steal_thread                                   = steal_thread,
-       .compute_priority                               = compute_priority,
-       .choose_processor                               = choose_processor,
-       .processor_enqueue                              = processor_enqueue,
-       .processor_queue_shutdown                       = processor_queue_shutdown,
-       .processor_queue_remove                         = processor_queue_remove,
-       .processor_queue_empty                          = sched_traditional_with_pset_runqueue_processor_queue_empty,
-       .priority_is_urgent                             = priority_is_urgent,
-       .processor_csw_check                            = processor_csw_check,
-       .processor_queue_has_priority                   = processor_queue_has_priority,
-       .initial_quantum_size                           = sched_traditional_initial_quantum_size,
-       .initial_thread_sched_mode                      = sched_traditional_initial_thread_sched_mode,
-       .can_update_priority                            = can_update_priority,
-       .update_priority                                = update_priority,
-       .lightweight_update_priority                    = lightweight_update_priority,
-       .quantum_expire                                 = sched_traditional_quantum_expire,
-       .should_current_thread_rechoose_processor       = should_current_thread_rechoose_processor,
-       .processor_runq_count                           = sched_traditional_processor_runq_count,
-       .processor_runq_stats_count_sum                 = sched_traditional_with_pset_runqueue_processor_runq_stats_count_sum,
-       .fairshare_init                                 = sched_traditional_fairshare_init,
-       .fairshare_runq_count                           = sched_traditional_fairshare_runq_count,
-       .fairshare_runq_stats_count_sum                 = sched_traditional_fairshare_runq_stats_count_sum,
-       .fairshare_enqueue                              = sched_traditional_fairshare_enqueue,
-       .fairshare_dequeue                              = sched_traditional_fairshare_dequeue,
-       .fairshare_queue_remove                         = sched_traditional_fairshare_queue_remove,
-       .processor_bound_count                          = sched_traditional_processor_bound_count,
-       .thread_update_scan                             = thread_update_scan,
-       .direct_dispatch_to_idle_processors             = FALSE,
-};
-
-#endif
-
 const struct sched_dispatch_table *sched_current_dispatch = NULL;
 
 /*
@@ -502,10 +283,9 @@ const struct sched_dispatch_table *sched_current_dispatch = NULL;
  * can run on multiple devices with different schedulers configured
  * in the device tree.
  */
-#define SCHED_STRING_MAX_LENGTH (48)
-
 char sched_string[SCHED_STRING_MAX_LENGTH];
-static enum sched_enum _sched_enum __attribute__((used)) = sched_enum_unknown;
+
+uint32_t sched_debug_flags;
 
 /* Global flag which indicates whether Background Stepper Context is enabled */
 static int cpu_throttle_enabled = 1;
@@ -541,75 +321,57 @@ sched_init(void)
                if (0) {
                        /* Allow pattern below */
 #if defined(CONFIG_SCHED_TRADITIONAL)
-               } else if (0 == strcmp(sched_arg, kSchedTraditionalString)) {
+               } else if (0 == strcmp(sched_arg, sched_traditional_dispatch.sched_name)) {
                        sched_current_dispatch = &sched_traditional_dispatch;
-                       _sched_enum = sched_enum_traditional;
-                       strlcpy(sched_string, kSchedTraditionalString, sizeof(sched_string));
-               } else if (0 == strcmp(sched_arg, kSchedTraditionalWithPsetRunqueueString)) {
+               } else if (0 == strcmp(sched_arg, sched_traditional_with_pset_runqueue_dispatch.sched_name)) {
                        sched_current_dispatch = &sched_traditional_with_pset_runqueue_dispatch;
-                       _sched_enum = sched_enum_traditional_with_pset_runqueue;
-                       strlcpy(sched_string, kSchedTraditionalWithPsetRunqueueString, sizeof(sched_string));
 #endif
 #if defined(CONFIG_SCHED_PROTO)
-               } else if (0 == strcmp(sched_arg, kSchedProtoString)) {
+               } else if (0 == strcmp(sched_arg, sched_proto_dispatch.sched_name)) {
                        sched_current_dispatch = &sched_proto_dispatch;
-                       _sched_enum = sched_enum_proto;
-                       strlcpy(sched_string, kSchedProtoString, sizeof(sched_string));
 #endif
 #if defined(CONFIG_SCHED_GRRR)
-               } else if (0 == strcmp(sched_arg, kSchedGRRRString)) {
+               } else if (0 == strcmp(sched_arg, sched_grrr_dispatch.sched_name)) {
                        sched_current_dispatch = &sched_grrr_dispatch;
-                       _sched_enum = sched_enum_grrr;
-                       strlcpy(sched_string, kSchedGRRRString, sizeof(sched_string));
 #endif
 #if defined(CONFIG_SCHED_MULTIQ)
-               } else if (0 == strcmp(sched_arg, kSchedMultiQString)) {
+               } else if (0 == strcmp(sched_arg, sched_multiq_dispatch.sched_name)) {
                        sched_current_dispatch = &sched_multiq_dispatch;
-                       _sched_enum = sched_enum_multiq;
-                       strlcpy(sched_string, kSchedMultiQString, sizeof(sched_string));
-               } else if (0 == strcmp(sched_arg, kSchedDualQString)) {
+               } else if (0 == strcmp(sched_arg, sched_dualq_dispatch.sched_name)) {
                        sched_current_dispatch = &sched_dualq_dispatch;
-                       _sched_enum = sched_enum_dualq;
-                       strlcpy(sched_string, kSchedDualQString, sizeof(sched_string));
 #endif
                } else {
 #if defined(CONFIG_SCHED_TRADITIONAL)
                        printf("Unrecognized scheduler algorithm: %s\n", sched_arg);
-                       printf("Scheduler: Using instead: %s\n", kSchedTraditionalWithPsetRunqueueString);
-
+                       printf("Scheduler: Using instead: %s\n", sched_traditional_with_pset_runqueue_dispatch.sched_name);
                        sched_current_dispatch = &sched_traditional_with_pset_runqueue_dispatch;
-                       _sched_enum = sched_enum_traditional_with_pset_runqueue;
-                       strlcpy(sched_string, kSchedTraditionalWithPsetRunqueueString, sizeof(sched_string));
 #else
                        panic("Unrecognized scheduler algorithm: %s", sched_arg);
 #endif
                }
-               kprintf("Scheduler: Runtime selection of %s\n", sched_string);
+               kprintf("Scheduler: Runtime selection of %s\n", SCHED(sched_name));
        } else {
 #if   defined(CONFIG_SCHED_MULTIQ)
                sched_current_dispatch = &sched_multiq_dispatch;
-               _sched_enum = sched_enum_multiq;
-               strlcpy(sched_string, kSchedMultiQString, sizeof(sched_string));
 #elif defined(CONFIG_SCHED_TRADITIONAL)
                sched_current_dispatch = &sched_traditional_with_pset_runqueue_dispatch;
-               _sched_enum = sched_enum_traditional_with_pset_runqueue;
-               strlcpy(sched_string, kSchedTraditionalWithPsetRunqueueString, sizeof(sched_string));
 #elif defined(CONFIG_SCHED_PROTO)
                sched_current_dispatch = &sched_proto_dispatch;
-               _sched_enum = sched_enum_proto;
-               strlcpy(sched_string, kSchedProtoString, sizeof(sched_string));
 #elif defined(CONFIG_SCHED_GRRR)
                sched_current_dispatch = &sched_grrr_dispatch;
-               _sched_enum = sched_enum_grrr;
-               strlcpy(sched_string, kSchedGRRRString, sizeof(sched_string));
 #else
 #error No default scheduler implementation
 #endif
-               kprintf("Scheduler: Default of %s\n", sched_string);
+               kprintf("Scheduler: Default of %s\n", SCHED(sched_name));
+       }
+
+       strlcpy(sched_string, SCHED(sched_name), sizeof(sched_string));
+
+       if (PE_parse_boot_argn("sched_debug", &sched_debug_flags, sizeof(sched_debug_flags))) {
+               kprintf("Scheduler: Debug flags 0x%08x\n", sched_debug_flags);
        }
        
        SCHED(init)();
-       SCHED(fairshare_init)();
        sched_realtime_init();
        ast_init();
        sched_timer_deadline_tracking_init();
@@ -633,7 +395,7 @@ sched_timebase_init(void)
 #if defined(CONFIG_SCHED_TIMESHARE_CORE)
 
 void
-sched_traditional_init(void)
+sched_timeshare_init(void)
 {
        /*
         * Calculate the timeslicing quantum
@@ -657,7 +419,7 @@ sched_traditional_init(void)
 }
 
 void
-sched_traditional_timebase_init(void)
+sched_timeshare_timebase_init(void)
 {
        uint64_t        abstime;
        uint32_t        shift;
@@ -694,69 +456,25 @@ sched_traditional_timebase_init(void)
                abstime >>= 1;
        sched_fixed_shift = shift;
 
+       for (uint32_t i = 0 ; i < TH_BUCKET_MAX ; i++)
+               sched_pri_shifts[i] = INT8_MAX;
+
        max_unsafe_computation = ((uint64_t)max_unsafe_quanta) * std_quantum;
        sched_safe_duration = 2 * ((uint64_t)max_unsafe_quanta) * std_quantum;
-       
+
        max_poll_computation = ((uint64_t)max_poll_quanta) * std_quantum;
        thread_depress_time = 1 * std_quantum;
        default_timeshare_computation = std_quantum / 2;
        default_timeshare_constraint = std_quantum;
 
-#if defined(CONFIG_TELEMETRY)
-       /* interval for high frequency telemetry */
-       clock_interval_to_absolutetime_interval(10, NSEC_PER_MSEC, &abstime);
-       assert((abstime >> 32) == 0 && (uint32_t)abstime != 0);
-       sched_telemetry_interval = (uint32_t)abstime;
-#endif
 }
 
 #endif /* CONFIG_SCHED_TIMESHARE_CORE */
 
-
-#if defined(CONFIG_SCHED_TRADITIONAL)
-
-static void
-sched_traditional_processor_init(processor_t processor)
-{
-       if (!sched_traditional_use_pset_runqueue) {
-               run_queue_init(&processor->runq);
-       }
-       processor->runq_bound_count = 0;
-}
-
-static void
-sched_traditional_pset_init(processor_set_t pset)
-{
-       if (sched_traditional_use_pset_runqueue) {
-               run_queue_init(&pset->pset_runq);
-       }
-       pset->pset_runq_bound_count = 0;
-}
-
-static void
-sched_traditional_with_pset_runqueue_init(void)
-{
-       sched_traditional_init();
-       sched_traditional_use_pset_runqueue = TRUE;
-}
-
-#endif /* CONFIG_SCHED_TRADITIONAL */
-
-#if defined(CONFIG_SCHED_FAIRSHARE_CORE)
-void
-sched_traditional_fairshare_init(void)
-{
-       simple_lock_init(&fs_lock, 0);
-       
-       fs_runq.count = 0;
-       queue_init(&fs_runq.queue);
-}
-#endif /* CONFIG_SCHED_FAIRSHARE_CORE */
-
 static void
 sched_realtime_init(void)
 {
-       simple_lock_init(&rt_lock, 0);
+       rt_lock_init();
 
        rt_runq.count = 0;
        queue_init(&rt_runq.queue);
@@ -802,10 +520,6 @@ load_shift_init(void)
                kprintf("Overriding scheduler decay usage age factor %u\n", sched_decay_usage_age_factor);
        }
 
-       if (PE_parse_boot_argn("sched_use_combined_fgbg_decay", &sched_use_combined_fgbg_decay, sizeof (sched_use_combined_fgbg_decay))) {
-               kprintf("Overriding schedule fg/bg decay calculation: %u\n", sched_use_combined_fgbg_decay);
-       }
-
        if (sched_decay_penalty == 0) {
                /*
                 * There is no penalty for timeshare threads for using too much
@@ -838,13 +552,13 @@ load_shift_init(void)
 static void
 preempt_pri_init(void)
 {
-       int             i, *p = sched_preempt_pri;
+       bitmap_t *p = sched_preempt_pri;
 
-       for (i = BASEPRI_FOREGROUND; i < MINPRI_KERNEL; ++i)
-               setbit(i, p);
+       for (int i = BASEPRI_FOREGROUND; i < MINPRI_KERNEL; ++i)
+               bitmap_set(p, i);
 
-       for (i = BASEPRI_PREEMPT; i <= MAXPRI; ++i)
-               setbit(i, p);
+       for (int i = BASEPRI_PREEMPT; i <= MAXPRI; ++i)
+               bitmap_set(p, i);
 }
 
 #endif /* CONFIG_SCHED_TIMESHARE_CORE */
@@ -860,6 +574,8 @@ thread_timer_expire(
        thread_t                thread = p0;
        spl_t                   s;
 
+       assert_thread_magic(thread);
+
        s = splsched();
        thread_lock(thread);
        if (--thread->wait_timer_active == 0) {
@@ -877,16 +593,18 @@ thread_timer_expire(
  *
  *     Unblock thread on wake up.
  *
- *     Returns TRUE if the thread is still running.
+ *     Returns TRUE if the thread should now be placed on the runqueue.
  *
  *     Thread must be locked.
+ *
+ *     Called at splsched().
  */
 boolean_t
 thread_unblock(
        thread_t                thread,
        wait_result_t   wresult)
 {
-       boolean_t               result = FALSE;
+       boolean_t               ready_for_runq = FALSE;
        thread_t                cthread = current_thread();
        uint32_t                new_run_count;
 
@@ -912,23 +630,18 @@ thread_unblock(
 
        if (!(thread->state & TH_RUN)) {
                thread->state |= TH_RUN;
+               thread->last_made_runnable_time = mach_approximate_time();
+
+               ready_for_runq = TRUE;
 
                (*thread->sched_call)(SCHED_CALL_UNBLOCK, thread);
 
-               /*
-                *      Update run counts.
-                */
+               /* Update the runnable thread count */
                new_run_count = sched_run_incr(thread);
-               if (thread->sched_mode == TH_MODE_TIMESHARE) {
-                       sched_share_incr(thread);
-
-                       if (thread->sched_flags & TH_SFLAG_THROTTLED)
-                               sched_background_incr(thread);
-               }
-       }
-       else {
+       } else {
                /*
-                *      Signal if idling on another processor.
+                * Either the thread is idling in place on another processor,
+                * or it hasn't finished context switching yet.
                 */
 #if CONFIG_SCHED_IDLE_IN_PLACE
                if (thread->state & TH_IDLE) {
@@ -940,16 +653,19 @@ thread_unblock(
 #else
                assert((thread->state & TH_IDLE) == 0);
 #endif
-
-               new_run_count = sched_run_count; /* updated in thread_select_idle() */
-               result = TRUE;
+               /*
+                * The run count is only dropped after the context switch completes
+                * and the thread is still waiting, so we should not run_incr here
+                */
+               new_run_count = sched_run_buckets[TH_BUCKET_RUN];
        }
 
+
        /*
         * Calculate deadline for real-time threads.
         */
        if (thread->sched_mode == TH_MODE_REALTIME) {
-               uint64_t                ctime;
+               uint64_t ctime;
 
                ctime = mach_absolute_time();
                thread->realtime.deadline = thread->realtime.constraint + ctime;
@@ -1010,11 +726,12 @@ thread_unblock(
 
        KERNEL_DEBUG_CONSTANT_IST(KDEBUG_TRACE,
                MACHDBG_CODE(DBG_MACH_SCHED,MACH_MAKE_RUNNABLE) | DBG_FUNC_NONE,
-               (uintptr_t)thread_tid(thread), thread->sched_pri, thread->wait_result, new_run_count, 0);
+               (uintptr_t)thread_tid(thread), thread->sched_pri, thread->wait_result,
+               sched_run_buckets[TH_BUCKET_RUN], 0);
 
        DTRACE_SCHED2(wakeup, struct thread *, thread, struct proc *, thread->task->bsd_info);
 
-       return (result);
+       return (ready_for_runq);
 }
 
 /*
@@ -1024,27 +741,36 @@ thread_unblock(
  *     Conditions:
  *             thread lock held, IPC locks may be held.
  *             thread must have been pulled from wait queue under same lock hold.
- *  Returns:
+ *             thread must have been waiting
+ *     Returns:
  *             KERN_SUCCESS - Thread was set running
- *             KERN_NOT_WAITING - Thread was not waiting
+ *
+ * TODO: This should return void
  */
 kern_return_t
 thread_go(
-       thread_t                thread,
-       wait_result_t   wresult)
+          thread_t        thread,
+          wait_result_t   wresult)
 {
+       assert_thread_magic(thread);
+
        assert(thread->at_safe_point == FALSE);
        assert(thread->wait_event == NO_EVENT64);
-       assert(thread->wait_queue == WAIT_QUEUE_NULL);
+       assert(thread->waitq == NULL);
+
+       assert(!(thread->state & (TH_TERMINATE|TH_TERMINATE2)));
+       assert(thread->state & TH_WAIT);
 
-       if ((thread->state & (TH_WAIT|TH_TERMINATE)) == TH_WAIT) {
-               if (!thread_unblock(thread, wresult))
-                       thread_setrun(thread, SCHED_PREEMPT | SCHED_TAILQ);
 
-               return (KERN_SUCCESS);
+       if (thread_unblock(thread, wresult)) {
+#if    SCHED_TRACE_THREAD_WAKEUPS
+               backtrace(&thread->thread_wakeup_bt[0],
+                   (sizeof(thread->thread_wakeup_bt)/sizeof(uintptr_t)));
+#endif
+               thread_setrun(thread, SCHED_PREEMPT | SCHED_TAILQ);
        }
 
-       return (KERN_NOT_WAITING);
+       return (KERN_SUCCESS);
 }
 
 /*
@@ -1064,7 +790,7 @@ thread_mark_wait_locked(
 {
        boolean_t               at_safe_point;
 
-       assert(thread == current_thread());
+       assert(!(thread->state & (TH_WAIT|TH_IDLE|TH_UNINT|TH_TERMINATE2)));
 
        /*
         *      The thread may have certain types of interrupts/aborts masked
@@ -1141,7 +867,7 @@ assert_wait_possible(void)
        
        thread = current_thread();
 
-       return (thread == NULL || wait_queue_assert_possible(thread));
+       return (thread == NULL || waitq_wait_possible(thread));
 }
 
 /*
@@ -1155,19 +881,28 @@ assert_wait(
        event_t                         event,
        wait_interrupt_t        interruptible)
 {
-       register wait_queue_t   wq;
-       register int            index;
-
-       if(event == NO_EVENT)
-               panic("assert_wait() called with NO_EVENT");
+       if (__improbable(event == NO_EVENT))
+               panic("%s() called with NO_EVENT", __func__);
 
        KERNEL_DEBUG_CONSTANT_IST(KDEBUG_TRACE,
                MACHDBG_CODE(DBG_MACH_SCHED, MACH_WAIT)|DBG_FUNC_NONE,
-               VM_KERNEL_UNSLIDE(event), 0, 0, 0, 0);
+               VM_KERNEL_UNSLIDE_OR_PERM(event), 0, 0, 0, 0);
+
+       struct waitq *waitq;
+       waitq = global_eventq(event);
+       return waitq_assert_wait64(waitq, CAST_EVENT64_T(event), interruptible, TIMEOUT_WAIT_FOREVER);
+}
 
-       index = wait_hash(event);
-       wq = &wait_queues[index];
-       return wait_queue_assert_wait(wq, event, interruptible, 0);
+/*
+ *     assert_wait_queue:
+ *
+ *     Return the global waitq for the specified event
+ */
+struct waitq *
+assert_wait_queue(
+       event_t                         event)
+{
+       return global_eventq(event);
 }
 
 wait_result_t
@@ -1179,36 +914,33 @@ assert_wait_timeout(
 {
        thread_t                        thread = current_thread();
        wait_result_t           wresult;
-       wait_queue_t            wqueue;
        uint64_t                        deadline;
        spl_t                           s;
 
-       if(event == NO_EVENT)
-               panic("assert_wait_timeout() called with NO_EVENT");
+       if (__improbable(event == NO_EVENT))
+               panic("%s() called with NO_EVENT", __func__);
 
-       wqueue = &wait_queues[wait_hash(event)];
+       struct waitq *waitq;
+       waitq = global_eventq(event);
 
        s = splsched();
-       wait_queue_lock(wqueue);
-       thread_lock(thread);
+       waitq_lock(waitq);
 
        clock_interval_to_deadline(interval, scale_factor, &deadline);
-       
+
        KERNEL_DEBUG_CONSTANT_IST(KDEBUG_TRACE,
-               MACHDBG_CODE(DBG_MACH_SCHED, MACH_WAIT)|DBG_FUNC_NONE,
-               VM_KERNEL_UNSLIDE(event), interruptible, deadline, 0, 0);
-       
-       wresult = wait_queue_assert_wait64_locked(wqueue, CAST_DOWN(event64_t, event),
-                                                 interruptible, 
-                                                 TIMEOUT_URGENCY_SYS_NORMAL,
-                                                 deadline, 0,
-                                                 thread);
+                                 MACHDBG_CODE(DBG_MACH_SCHED, MACH_WAIT)|DBG_FUNC_NONE,
+                                 VM_KERNEL_UNSLIDE_OR_PERM(event), interruptible, deadline, 0, 0);
 
-       thread_unlock(thread);
-       wait_queue_unlock(wqueue);
-       splx(s);
+       wresult = waitq_assert_wait64_locked(waitq, CAST_EVENT64_T(event),
+                                            interruptible,
+                                            TIMEOUT_URGENCY_SYS_NORMAL,
+                                            deadline, TIMEOUT_NO_LEEWAY,
+                                            thread);
 
-       return (wresult);
+       waitq_unlock(waitq);
+       splx(s);
+       return wresult;
 }
 
 wait_result_t
@@ -1222,42 +954,39 @@ assert_wait_timeout_with_leeway(
 {
        thread_t                        thread = current_thread();
        wait_result_t           wresult;
-       wait_queue_t            wqueue;
        uint64_t                        deadline;
        uint64_t                        abstime;
        uint64_t                        slop;
        uint64_t                        now;
        spl_t                           s;
 
+       if (__improbable(event == NO_EVENT))
+               panic("%s() called with NO_EVENT", __func__);
+
        now = mach_absolute_time();
        clock_interval_to_absolutetime_interval(interval, scale_factor, &abstime);
        deadline = now + abstime;
 
        clock_interval_to_absolutetime_interval(leeway, scale_factor, &slop);
 
-       if(event == NO_EVENT)
-               panic("assert_wait_timeout_with_leeway() called with NO_EVENT");
-
-       wqueue = &wait_queues[wait_hash(event)];
+       struct waitq *waitq;
+       waitq = global_eventq(event);
 
        s = splsched();
-       wait_queue_lock(wqueue);
-       thread_lock(thread);
+       waitq_lock(waitq);
 
        KERNEL_DEBUG_CONSTANT_IST(KDEBUG_TRACE,
-               MACHDBG_CODE(DBG_MACH_SCHED, MACH_WAIT)|DBG_FUNC_NONE,
-               VM_KERNEL_UNSLIDE(event), interruptible, deadline, 0, 0);
-       
-       wresult = wait_queue_assert_wait64_locked(wqueue, CAST_DOWN(event64_t, event),
-                                                 interruptible,
-                                                 urgency, deadline, slop,
-                                                 thread);
+                                 MACHDBG_CODE(DBG_MACH_SCHED, MACH_WAIT)|DBG_FUNC_NONE,
+                                 VM_KERNEL_UNSLIDE_OR_PERM(event), interruptible, deadline, 0, 0);
 
-       thread_unlock(thread);
-       wait_queue_unlock(wqueue);
-       splx(s);
+       wresult = waitq_assert_wait64_locked(waitq, CAST_EVENT64_T(event),
+                                            interruptible,
+                                            urgency, deadline, slop,
+                                            thread);
 
-       return (wresult);
+       waitq_unlock(waitq);
+       splx(s);
+       return wresult;
 }
 
 wait_result_t
@@ -1268,30 +997,28 @@ assert_wait_deadline(
 {
        thread_t                        thread = current_thread();
        wait_result_t           wresult;
-       wait_queue_t            wqueue;
        spl_t                           s;
 
-       assert(event != NO_EVENT);
-       wqueue = &wait_queues[wait_hash(event)];
+       if (__improbable(event == NO_EVENT))
+               panic("%s() called with NO_EVENT", __func__);
+
+       struct waitq *waitq;
+       waitq = global_eventq(event);
 
        s = splsched();
-       wait_queue_lock(wqueue);
-       thread_lock(thread);
+       waitq_lock(waitq);
 
        KERNEL_DEBUG_CONSTANT_IST(KDEBUG_TRACE,
-               MACHDBG_CODE(DBG_MACH_SCHED, MACH_WAIT)|DBG_FUNC_NONE,
-               VM_KERNEL_UNSLIDE(event), interruptible, deadline, 0, 0);
-
-       wresult = wait_queue_assert_wait64_locked(wqueue, CAST_DOWN(event64_t,event),
-                                                 interruptible, 
-                                                 TIMEOUT_URGENCY_SYS_NORMAL, deadline, 0,
-                                                 thread);
-
-       thread_unlock(thread);
-       wait_queue_unlock(wqueue);
+                                 MACHDBG_CODE(DBG_MACH_SCHED, MACH_WAIT)|DBG_FUNC_NONE,
+                                 VM_KERNEL_UNSLIDE_OR_PERM(event), interruptible, deadline, 0, 0);
+
+       wresult = waitq_assert_wait64_locked(waitq, CAST_EVENT64_T(event),
+                                            interruptible,
+                                            TIMEOUT_URGENCY_SYS_NORMAL, deadline,
+                                            TIMEOUT_NO_LEEWAY, thread);
+       waitq_unlock(waitq);
        splx(s);
-
-       return (wresult);
+       return wresult;
 }
 
 wait_result_t
@@ -1304,32 +1031,28 @@ assert_wait_deadline_with_leeway(
 {
        thread_t                        thread = current_thread();
        wait_result_t           wresult;
-       wait_queue_t            wqueue;
        spl_t                           s;
 
-       if(event == NO_EVENT)
-               panic("assert_wait_deadline_with_leeway() called with NO_EVENT");
+       if (__improbable(event == NO_EVENT))
+               panic("%s() called with NO_EVENT", __func__);
 
-       wqueue = &wait_queues[wait_hash(event)];
+       struct waitq *waitq;
+       waitq = global_eventq(event);
 
        s = splsched();
-       wait_queue_lock(wqueue);
-       thread_lock(thread);
+       waitq_lock(waitq);
 
        KERNEL_DEBUG_CONSTANT_IST(KDEBUG_TRACE,
-               MACHDBG_CODE(DBG_MACH_SCHED, MACH_WAIT)|DBG_FUNC_NONE,
-               VM_KERNEL_UNSLIDE(event), interruptible, deadline, 0, 0);
-
-       wresult = wait_queue_assert_wait64_locked(wqueue, CAST_DOWN(event64_t,event),
-                                                 interruptible, 
-                                                 urgency, deadline, leeway,
-                                                 thread);
-
-       thread_unlock(thread);
-       wait_queue_unlock(wqueue);
+                                 MACHDBG_CODE(DBG_MACH_SCHED, MACH_WAIT)|DBG_FUNC_NONE,
+                                 VM_KERNEL_UNSLIDE_OR_PERM(event), interruptible, deadline, 0, 0);
+
+       wresult = waitq_assert_wait64_locked(waitq, CAST_EVENT64_T(event),
+                                            interruptible,
+                                            urgency, deadline, leeway,
+                                            thread);
+       waitq_unlock(waitq);
        splx(s);
-
-       return (wresult);
+       return wresult;
 }
 
 /*
@@ -1355,6 +1078,13 @@ thread_isoncpu(thread_t thread)
        if (thread->runq != PROCESSOR_NULL)
                return (FALSE);
 
+       /*
+        * Thread does not have a stack yet
+        * It could be on the stack alloc queue or preparing to be invoked
+        */
+       if (!thread->kernel_stack)
+               return (FALSE);
+
        /*
         * Thread must be running on a processor, or
         * about to run, or just did run. In all these
@@ -1474,13 +1204,8 @@ thread_unstop(
        wake_lock(thread);
        thread_lock(thread);
 
-       if ((thread->state & (TH_RUN|TH_WAIT|TH_SUSP)) == TH_SUSP) {
-               thread->state &= ~TH_SUSP;
-               thread_unblock(thread, THREAD_AWAKENED);
+       assert((thread->state & (TH_RUN|TH_WAIT|TH_SUSP)) != TH_SUSP);
 
-               thread_setrun(thread, SCHED_PREEMPT | SCHED_TAILQ);
-       }
-       else
        if (thread->state & TH_SUSP) {
                thread->state &= ~TH_SUSP;
 
@@ -1577,35 +1302,35 @@ clear_wait_internal(
        thread_t                thread,
        wait_result_t   wresult)
 {
-       wait_queue_t    wq = thread->wait_queue;
-       uint32_t        i = LockTimeOut;
-
+       uint32_t        i = LockTimeOutUsec;
+       struct waitq *waitq = thread->waitq;
+       
        do {
                if (wresult == THREAD_INTERRUPTED && (thread->state & TH_UNINT))
                        return (KERN_FAILURE);
 
-               if (wq != WAIT_QUEUE_NULL) {
-                       if (wait_queue_lock_try(wq)) {
-                               wait_queue_pull_thread_locked(wq, thread, TRUE);
-                               /* wait queue unlocked, thread still locked */
-                       }
-                       else {
+               if (waitq != NULL) {
+                       if (!waitq_pull_thread_locked(waitq, thread)) {
                                thread_unlock(thread);
                                delay(1);
-
+                               if (i > 0 && !machine_timeout_suspended())
+                                       i--;
                                thread_lock(thread);
-                               if (wq != thread->wait_queue)
-                                       return (KERN_NOT_WAITING);
-
+                               if (waitq != thread->waitq)
+                                       return KERN_NOT_WAITING;
                                continue;
                        }
                }
 
-               return (thread_go(thread, wresult));
-       } while ((--i > 0) || machine_timeout_suspended());
+               /* TODO: Can we instead assert TH_TERMINATE is not set?  */
+               if ((thread->state & (TH_WAIT|TH_TERMINATE)) == TH_WAIT)
+                       return (thread_go(thread, wresult));
+               else
+                       return (KERN_NOT_WAITING);
+       } while (i > 0);
 
        panic("clear_wait_internal: deadlock: thread=%p, wq=%p, cpu=%d\n",
-                 thread, wq, cpu_number());
+                 thread, waitq, cpu_number());
 
        return (KERN_FAILURE);
 }
@@ -1647,33 +1372,72 @@ clear_wait(
  */
 kern_return_t
 thread_wakeup_prim(
-       event_t                 event,
-       boolean_t               one_thread,
-       wait_result_t           result)
+                   event_t          event,
+                   boolean_t        one_thread,
+                   wait_result_t    result)
 {
-       return (thread_wakeup_prim_internal(event, one_thread, result, -1));
+       if (__improbable(event == NO_EVENT))
+               panic("%s() called with NO_EVENT", __func__);
+
+       struct waitq *wq = global_eventq(event);
+
+       if (one_thread)
+               return waitq_wakeup64_one(wq, CAST_EVENT64_T(event), result, WAITQ_ALL_PRIORITIES);
+       else
+               return waitq_wakeup64_all(wq, CAST_EVENT64_T(event), result, WAITQ_ALL_PRIORITIES);
 }
 
+/*
+ * Wakeup a specified thread if and only if it's waiting for this event
+ */
+kern_return_t
+thread_wakeup_thread(
+                     event_t         event,
+                     thread_t        thread)
+{
+       if (__improbable(event == NO_EVENT))
+               panic("%s() called with NO_EVENT", __func__);
+
+       struct waitq *wq = global_eventq(event);
+
+       return waitq_wakeup64_thread(wq, CAST_EVENT64_T(event), thread, THREAD_AWAKENED);
+}
 
+/*
+ * Wakeup a thread waiting on an event and promote it to a priority.
+ *
+ * Requires woken thread to un-promote itself when done.
+ */
 kern_return_t
-thread_wakeup_prim_internal(
-       event_t                 event,
-       boolean_t               one_thread,
-       wait_result_t           result,
-       int                     priority)
+thread_wakeup_one_with_pri(
+                           event_t      event,
+                           int          priority)
 {
-       register wait_queue_t   wq;
-       register int                    index;
+       if (__improbable(event == NO_EVENT))
+               panic("%s() called with NO_EVENT", __func__);
 
-       if(event == NO_EVENT)
-               panic("thread_wakeup_prim() called with NO_EVENT");
+       struct waitq *wq = global_eventq(event);
 
-       index = wait_hash(event);
-       wq = &wait_queues[index];
-       if (one_thread)
-               return (wait_queue_wakeup_one(wq, event, result, priority));
-       else
-           return (wait_queue_wakeup_all(wq, event, result));
+       return waitq_wakeup64_one(wq, CAST_EVENT64_T(event), THREAD_AWAKENED, priority);
+}
+
+/*
+ * Wakeup a thread waiting on an event,
+ * promote it to a priority,
+ * and return a reference to the woken thread.
+ *
+ * Requires woken thread to un-promote itself when done.
+ */
+thread_t
+thread_wakeup_identify(event_t  event,
+                       int      priority)
+{
+       if (__improbable(event == NO_EVENT))
+               panic("%s() called with NO_EVENT", __func__);
+
+       struct waitq *wq = global_eventq(event);
+
+       return waitq_wakeup64_identify(wq, CAST_EVENT64_T(event), THREAD_AWAKENED, priority);
 }
 
 /*
@@ -1698,11 +1462,7 @@ thread_bind(
        s = splsched();
        thread_lock(self);
 
-       /* <rdar://problem/15102234> */
-       assert(self->sched_pri < BASEPRI_RTQUEUES);
-
-       prev = self->bound_processor;
-       self->bound_processor = processor;
+       prev = thread_bind_internal(self, processor);
 
        thread_unlock(self);
        splx(s);
@@ -1710,55 +1470,239 @@ thread_bind(
        return (prev);
 }
 
-/* Invoked prior to idle entry to determine if, on SMT capable processors, an SMT
- * rebalancing opportunity exists when a core is (instantaneously) idle, but
- * other SMT-capable cores may be over-committed. TODO: some possible negatives:
- * IPI thrash if this core does not remain idle following the load balancing ASTs
- * Idle "thrash", when IPI issue is followed by idle entry/core power down
- * followed by a wakeup shortly thereafter.
+/*
+ * thread_bind_internal:
+ *
+ * If the specified thread is not the current thread, and it is currently
+ * running on another CPU, a remote AST must be sent to that CPU to cause
+ * the thread to migrate to its bound processor. Otherwise, the migration
+ * will occur at the next quantum expiration or blocking point.
+ *
+ * When the thread is the current thread, and explicit thread_block() should
+ * be used to force the current processor to context switch away and
+ * let the thread migrate to the bound processor.
+ *
+ * Thread must be locked, and at splsched.
  */
 
-/* Invoked with pset locked, returns with pset unlocked */
-#if (DEVELOPMENT || DEBUG)
-int sched_smt_balance = 1;
-#endif
+static processor_t
+thread_bind_internal(
+       thread_t                thread,
+       processor_t             processor)
+{
+       processor_t             prev;
 
-static void
-sched_SMT_balance(processor_t cprocessor, processor_set_t cpset) {
-       processor_t ast_processor = NULL;
+       /* <rdar://problem/15102234> */
+       assert(thread->sched_pri < BASEPRI_RTQUEUES);
+       /* A thread can't be bound if it's sitting on a (potentially incorrect) runqueue */
+       assert(thread->runq == PROCESSOR_NULL);
 
-#if (DEVELOPMENT || DEBUG)
-       if (__improbable(sched_smt_balance == 0))
-               goto smt_balance_exit;
-#endif
-       
-       assert(cprocessor == current_processor());
-       if (cprocessor->is_SMT == FALSE)
-               goto smt_balance_exit;
+       KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_SCHED, MACH_THREAD_BIND), thread_tid(thread), processor ? (uintptr_t)processor->cpu_id : (uintptr_t)-1, 0, 0, 0);
 
-       processor_t sib_processor = cprocessor->processor_secondary ? cprocessor->processor_secondary : cprocessor->processor_primary;
+       prev = thread->bound_processor;
+       thread->bound_processor = processor;
 
-       /* Determine if both this processor and its sibling are idle,
-        * indicating an SMT rebalancing opportunity.
+       return (prev);
+}
+
+/*
+ * thread_vm_bind_group_add:
+ *
+ * The "VM bind group" is a special mechanism to mark a collection
+ * of threads from the VM subsystem that, in general, should be scheduled
+ * with only one CPU of parallelism. To accomplish this, we initially
+ * bind all the threads to the master processor, which has the effect
+ * that only one of the threads in the group can execute at once, including
+ * preempting threads in the group that are a lower priority. Future
+ * mechanisms may use more dynamic mechanisms to prevent the collection
+ * of VM threads from using more CPU time than desired.
+ *
+ * The current implementation can result in priority inversions where
+ * compute-bound priority 95 or realtime threads that happen to have
+ * landed on the master processor prevent the VM threads from running.
+ * When this situation is detected, we unbind the threads for one
+ * scheduler tick to allow the scheduler to run the threads an
+ * additional CPUs, before restoring the binding (assuming high latency
+ * is no longer a problem).
+ */
+
+/*
+ * The current max is provisioned for:
+ * vm_compressor_swap_trigger_thread (92)
+ * 2 x vm_pageout_iothread_internal (92) when vm_restricted_to_single_processor==TRUE
+ * vm_pageout_continue (92)
+ * memorystatus_thread (95)
+ */
+#define MAX_VM_BIND_GROUP_COUNT (5)
+decl_simple_lock_data(static,sched_vm_group_list_lock);
+static thread_t sched_vm_group_thread_list[MAX_VM_BIND_GROUP_COUNT];
+static int sched_vm_group_thread_count;
+static boolean_t sched_vm_group_temporarily_unbound = FALSE;
+
+void
+thread_vm_bind_group_add(void)
+{
+       thread_t self = current_thread();
+
+       thread_reference_internal(self);
+       self->options |= TH_OPT_SCHED_VM_GROUP;
+
+       simple_lock(&sched_vm_group_list_lock);
+       assert(sched_vm_group_thread_count < MAX_VM_BIND_GROUP_COUNT);
+       sched_vm_group_thread_list[sched_vm_group_thread_count++] = self;
+       simple_unlock(&sched_vm_group_list_lock);
+
+       thread_bind(master_processor);
+
+       /* Switch to bound processor if not already there */
+       thread_block(THREAD_CONTINUE_NULL);
+}
+
+static void
+sched_vm_group_maintenance(void)
+{
+       uint64_t ctime = mach_absolute_time();
+       uint64_t longtime = ctime - sched_tick_interval;
+       int i;
+       spl_t s;
+       boolean_t high_latency_observed = FALSE;
+       boolean_t runnable_and_not_on_runq_observed = FALSE;
+       boolean_t bind_target_changed = FALSE;
+       processor_t bind_target = PROCESSOR_NULL;
+
+       /* Make sure nobody attempts to add new threads while we are enumerating them */
+       simple_lock(&sched_vm_group_list_lock);
+
+       s = splsched();
+
+       for (i=0; i < sched_vm_group_thread_count; i++) {
+               thread_t thread = sched_vm_group_thread_list[i];
+               assert(thread != THREAD_NULL);
+               thread_lock(thread);
+               if ((thread->state & (TH_RUN|TH_WAIT)) == TH_RUN) {
+                       if (thread->runq != PROCESSOR_NULL && thread->last_made_runnable_time < longtime) {
+                               high_latency_observed = TRUE;
+                       } else if (thread->runq == PROCESSOR_NULL) {
+                               /* There are some cases where a thread be transitiong that also fall into this case */
+                               runnable_and_not_on_runq_observed = TRUE;
+                       }
+               }
+               thread_unlock(thread);
+
+               if (high_latency_observed && runnable_and_not_on_runq_observed) {
+                       /* All the things we are looking for are true, stop looking */
+                       break;
+               }
+       }
+
+       splx(s);
+
+       if (sched_vm_group_temporarily_unbound) {
+               /* If we turned off binding, make sure everything is OK before rebinding */
+               if (!high_latency_observed) {
+                       /* rebind */
+                       bind_target_changed = TRUE;
+                       bind_target = master_processor;
+                       sched_vm_group_temporarily_unbound = FALSE; /* might be reset to TRUE if change cannot be completed */
+               }
+       } else {
+               /*
+                * Check if we're in a bad state, which is defined by high
+                * latency with no core currently executing a thread. If a
+                * single thread is making progress on a CPU, that means the
+                * binding concept to reduce parallelism is working as
+                * designed.
+                */
+               if (high_latency_observed && !runnable_and_not_on_runq_observed) {
+                       /* unbind */
+                       bind_target_changed = TRUE;
+                       bind_target = PROCESSOR_NULL;
+                       sched_vm_group_temporarily_unbound = TRUE;
+               }
+       }
+
+       if (bind_target_changed) {
+               s = splsched();
+               for (i=0; i < sched_vm_group_thread_count; i++) {
+                       thread_t thread = sched_vm_group_thread_list[i];
+                       boolean_t removed;
+                       assert(thread != THREAD_NULL);
+
+                       thread_lock(thread);
+                       removed = thread_run_queue_remove(thread);
+                       if (removed || ((thread->state & (TH_RUN | TH_WAIT)) == TH_WAIT)) {
+                               thread_bind_internal(thread, bind_target);
+                       } else {
+                               /*
+                                * Thread was in the middle of being context-switched-to,
+                                * or was in the process of blocking. To avoid switching the bind
+                                * state out mid-flight, defer the change if possible.
+                                */
+                               if (bind_target == PROCESSOR_NULL) {
+                                       thread_bind_internal(thread, bind_target);
+                               } else {
+                                       sched_vm_group_temporarily_unbound = TRUE; /* next pass will try again */
+                               }
+                       }
+
+                       if (removed) {
+                               thread_run_queue_reinsert(thread, SCHED_PREEMPT | SCHED_TAILQ);
+                       }
+                       thread_unlock(thread);
+               }
+               splx(s);
+       }
+
+       simple_unlock(&sched_vm_group_list_lock);
+}
+
+/* Invoked prior to idle entry to determine if, on SMT capable processors, an SMT
+ * rebalancing opportunity exists when a core is (instantaneously) idle, but
+ * other SMT-capable cores may be over-committed. TODO: some possible negatives:
+ * IPI thrash if this core does not remain idle following the load balancing ASTs
+ * Idle "thrash", when IPI issue is followed by idle entry/core power down
+ * followed by a wakeup shortly thereafter.
+ */
+
+#if (DEVELOPMENT || DEBUG)
+int sched_smt_balance = 1;
+#endif
+
+#if __SMP__
+/* Invoked with pset locked, returns with pset unlocked */
+static void
+sched_SMT_balance(processor_t cprocessor, processor_set_t cpset) {
+       processor_t ast_processor = NULL;
+
+#if (DEVELOPMENT || DEBUG)
+       if (__improbable(sched_smt_balance == 0))
+               goto smt_balance_exit;
+#endif
+       
+       assert(cprocessor == current_processor());
+       if (cprocessor->is_SMT == FALSE)
+               goto smt_balance_exit;
+
+       processor_t sib_processor = cprocessor->processor_secondary ? cprocessor->processor_secondary : cprocessor->processor_primary;
+
+       /* Determine if both this processor and its sibling are idle,
+        * indicating an SMT rebalancing opportunity.
         */
        if (sib_processor->state != PROCESSOR_IDLE)
                goto smt_balance_exit;
 
        processor_t sprocessor;
 
-       sprocessor = (processor_t)queue_first(&cpset->active_queue);
-
-       while (!queue_end(&cpset->active_queue, (queue_entry_t)sprocessor)) {
+       qe_foreach_element(sprocessor, &cpset->active_queue, processor_queue) {
                if ((sprocessor->state == PROCESSOR_RUNNING) &&
                    (sprocessor->processor_primary != sprocessor) &&
                    (sprocessor->processor_primary->state == PROCESSOR_RUNNING) &&
                    (sprocessor->current_pri < BASEPRI_RTQUEUES) &&
-                   ((cpset->pending_AST_cpu_mask & (1U << sprocessor->cpu_id)) == 0)) {
+                   ((cpset->pending_AST_cpu_mask & (1ULL << sprocessor->cpu_id)) == 0)) {
                        assert(sprocessor != cprocessor);
                        ast_processor = sprocessor;
                        break;
                }
-               sprocessor = (processor_t)queue_next((queue_entry_t)sprocessor);
        }
 
 smt_balance_exit:
@@ -1769,6 +1713,7 @@ smt_balance_exit:
                cause_ast_check(ast_processor);
        }
 }
+#endif /* __SMP__ */
 
 /*
  *     thread_select:
@@ -1787,6 +1732,7 @@ thread_select(
        thread_t                        new_thread = THREAD_NULL;
 
        assert(processor == current_processor());
+       assert((thread->state & (TH_RUN|TH_TERMINATE2)) == TH_RUN);
 
        do {
                /*
@@ -1803,7 +1749,15 @@ thread_select(
 
                assert(processor->state != PROCESSOR_OFF_LINE);
 
-               if (processor->processor_primary != processor) {
+               if (!processor->is_recommended) {
+                       /*
+                        * The performance controller has provided a hint to not dispatch more threads,
+                        * unless they are bound to us (and thus we are the only option
+                        */
+                       if (!SCHED(processor_bound_count)(processor)) {
+                               goto idle;
+                       }
+               } else if (processor->processor_primary != processor) {
                        /*
                         * Should this secondary SMT processor attempt to find work? For pset runqueue systems,
                         * we should look for work only under the same conditions that choose_processor()
@@ -1817,117 +1771,116 @@ thread_select(
                        }
                }
 
-               simple_lock(&rt_lock);
+               rt_lock_lock();
 
                /*
                 *      Test to see if the current thread should continue
-                *      to run on this processor.  Must be runnable, and not
+                *      to run on this processor.  Must not be attempting to wait, and not
                 *      bound to a different processor, nor be in the wrong
-                *      processor set.
+                *      processor set, nor be forced to context switch by TH_SUSP.
+                *
+                *      Note that there are never any RT threads in the regular runqueue.
+                *
+                *      This code is very insanely tricky.
                 */
-               if (((thread->state & ~TH_SUSP) == TH_RUN) &&
+
+               if (((thread->state & (TH_TERMINATE|TH_IDLE|TH_WAIT|TH_RUN|TH_SUSP)) == TH_RUN) &&
                    (thread->sched_pri >= BASEPRI_RTQUEUES     || processor->processor_primary == processor) &&
                    (thread->bound_processor == PROCESSOR_NULL || thread->bound_processor == processor)      &&
                    (thread->affinity_set == AFFINITY_SET_NULL || thread->affinity_set->aset_pset == pset)) {
-                       if (thread->sched_pri >= BASEPRI_RTQUEUES && first_timeslice(processor)) {
+                       /*
+                        * RT threads with un-expired quantum stay on processor,
+                        * unless there's a valid RT thread with an earlier deadline.
+                        */
+                       if (thread->sched_pri >= BASEPRI_RTQUEUES && processor->first_timeslice) {
                                if (rt_runq.count > 0) {
-                                       thread_t next_rt;
+                                       thread_t next_rt = qe_queue_first(&rt_runq.queue, struct thread, runq_links);
+
+                                       assert(next_rt->runq == THREAD_ON_RT_RUNQ);
 
-                                       next_rt = (thread_t)queue_first(&rt_runq.queue);
                                        if (next_rt->realtime.deadline < processor->deadline &&
-                                          (next_rt->bound_processor == PROCESSOR_NULL || next_rt->bound_processor == processor)) {
-                                               thread = (thread_t)dequeue_head(&rt_runq.queue);
-                                               thread->runq = PROCESSOR_NULL;
-                                               SCHED_STATS_RUNQ_CHANGE(&rt_runq.runq_stats, rt_runq.count);
-                                               rt_runq.count--;
+                                           (next_rt->bound_processor == PROCESSOR_NULL ||
+                                            next_rt->bound_processor == processor)) {
+                                               /* The next RT thread is better, so pick it off the runqueue. */
+                                               goto pick_new_rt_thread;
                                        }
                                }
 
-                               simple_unlock(&rt_lock);
-
+                               /* This is still the best RT thread to run. */
                                processor->deadline = thread->realtime.deadline;
 
+                               rt_lock_unlock();
                                pset_unlock(pset);
 
                                return (thread);
                        }
 
-                       if ((thread->sched_mode != TH_MODE_FAIRSHARE || SCHED(fairshare_runq_count)() == 0) && (rt_runq.count == 0 || BASEPRI_RTQUEUES < thread->sched_pri) && (new_thread = SCHED(choose_thread)(processor, thread->sched_mode == TH_MODE_FAIRSHARE ? MINPRI : thread->sched_pri, reason)) == THREAD_NULL) {
-
-                               simple_unlock(&rt_lock);
-
+                       if ((rt_runq.count == 0) &&
+                           SCHED(processor_queue_has_priority)(processor, thread->sched_pri, TRUE) == FALSE) {
                                /* This thread is still the highest priority runnable (non-idle) thread */
-
                                processor->deadline = UINT64_MAX;
 
+                               rt_lock_unlock();
                                pset_unlock(pset);
 
                                return (thread);
                        }
                }
 
-               if (new_thread != THREAD_NULL ||
-                               (SCHED(processor_queue_has_priority)(processor, rt_runq.count == 0 ? IDLEPRI : BASEPRI_RTQUEUES, TRUE) &&
-                                        (new_thread = SCHED(choose_thread)(processor, MINPRI, reason)) != THREAD_NULL)) {
-                               simple_unlock(&rt_lock);
-
-                               processor->deadline = UINT64_MAX;
-                               pset_unlock(pset);
-
-                               return (new_thread);
-               }
-
+               /* OK, so we're not going to run the current thread. Look at the RT queue. */
                if (rt_runq.count > 0) {
-                       thread_t next_rt = (thread_t)queue_first(&rt_runq.queue);
+                       thread_t next_rt = qe_queue_first(&rt_runq.queue, struct thread, runq_links);
 
-                       if (__probable((next_rt->bound_processor == NULL || (next_rt->bound_processor == processor)))) {
-                               thread = (thread_t)dequeue_head(&rt_runq.queue);
+                       assert(next_rt->runq == THREAD_ON_RT_RUNQ);
 
-                               thread->runq = PROCESSOR_NULL;
+                       if (__probable((next_rt->bound_processor == PROCESSOR_NULL ||
+                                      (next_rt->bound_processor == processor)))) {
+pick_new_rt_thread:
+                               new_thread = qe_dequeue_head(&rt_runq.queue, struct thread, runq_links);
+
+                               new_thread->runq = PROCESSOR_NULL;
                                SCHED_STATS_RUNQ_CHANGE(&rt_runq.runq_stats, rt_runq.count);
                                rt_runq.count--;
 
-                               simple_unlock(&rt_lock);
+                               processor->deadline = new_thread->realtime.deadline;
 
-                               processor->deadline = thread->realtime.deadline;
+                               rt_lock_unlock();
                                pset_unlock(pset);
 
-                               return (thread);
+                               return (new_thread);
                        }
                }
 
-               simple_unlock(&rt_lock);
-
-               /* No realtime threads and no normal threads on the per-processor
-                * runqueue. Finally check for global fairshare threads.
-                */
-               if ((new_thread = SCHED(fairshare_dequeue)()) != THREAD_NULL) {
+               processor->deadline = UINT64_MAX;
+               rt_lock_unlock();
 
-                       processor->deadline = UINT64_MAX;
+               /* No RT threads, so let's look at the regular threads. */
+               if ((new_thread = SCHED(choose_thread)(processor, MINPRI, reason)) != THREAD_NULL) {
                        pset_unlock(pset);
-                       
                        return (new_thread);
                }
-                       
-               processor->deadline = UINT64_MAX;
 
-               /*
-                *      No runnable threads, attempt to steal
-                *      from other processors.
-                */
-               new_thread = SCHED(steal_thread)(pset);
-               if (new_thread != THREAD_NULL) {
-                       return (new_thread);
-               }
+#if __SMP__
+               if (SCHED(steal_thread_enabled)) {
+                       /*
+                        * No runnable threads, attempt to steal
+                        * from other processors. Returns with pset lock dropped.
+                        */
 
-               /*
-                *      If other threads have appeared, shortcut
-                *      around again.
-                */
-               if (!SCHED(processor_queue_empty)(processor) || rt_runq.count > 0 || SCHED(fairshare_runq_count)() > 0)
-                       continue;
+                       if ((new_thread = SCHED(steal_thread)(pset)) != THREAD_NULL) {
+                               return (new_thread);
+                       }
 
-               pset_lock(pset);
+                       /*
+                        * If other threads have appeared, shortcut
+                        * around again.
+                        */
+                       if (!SCHED(processor_queue_empty)(processor) || rt_runq.count > 0)
+                               continue;
+
+                       pset_lock(pset);
+               }
+#endif
 
        idle:
                /*
@@ -1935,19 +1888,21 @@ thread_select(
                 *      was running.
                 */
                if (processor->state == PROCESSOR_RUNNING) {
-                       remqueue((queue_entry_t)processor);
                        processor->state = PROCESSOR_IDLE;
 
                        if (processor->processor_primary == processor) {
-                               enqueue_head(&pset->idle_queue, (queue_entry_t)processor);
-                       }
-                       else {
-                               enqueue_head(&pset->idle_secondary_queue, (queue_entry_t)processor);
+                               re_queue_head(&pset->idle_queue, &processor->processor_queue);
+                       } else {
+                               re_queue_head(&pset->idle_secondary_queue, &processor->processor_queue);
                        }
                }
 
+#if __SMP__
                /* Invoked with pset locked, returns with pset unlocked */
                sched_SMT_balance(processor, pset);
+#else
+               pset_unlock(pset);
+#endif
 
 #if CONFIG_SCHED_IDLE_IN_PLACE
                /*
@@ -1973,7 +1928,7 @@ thread_select(
                 * thread can start running on another processor without
                 * waiting for the fast-idled processor to wake up.
                 */
-               return (processor->idle_thread);
+               new_thread = processor->idle_thread;
 
 #endif /* !CONFIG_SCHED_IDLE_IN_PLACE */
 
@@ -1999,12 +1954,6 @@ thread_select_idle(
        uint64_t                arg1, arg2;
        int                     urgency;
 
-       if (thread->sched_mode == TH_MODE_TIMESHARE) {
-               if (thread->sched_flags & TH_SFLAG_THROTTLED)
-                       sched_background_decr(thread);
-
-               sched_share_decr(thread);
-       }
        sched_run_decr(thread);
 
        thread->state |= TH_IDLE;
@@ -2034,11 +1983,11 @@ thread_select_idle(
         *      Cancel the quantum timer while idling.
         */
        timer_call_cancel(&processor->quantum_timer);
-       processor->timeslice = 0;
+       processor->first_timeslice = FALSE;
 
        (*thread->sched_call)(SCHED_CALL_BLOCK, thread);
 
-       thread_tell_urgency(THREAD_URGENCY_NONE, 0, 0, NULL);
+       thread_tell_urgency(THREAD_URGENCY_NONE, 0, 0, 0, NULL);
 
        /*
         *      Enable interrupts and perform idling activities.  No
@@ -2065,121 +2014,32 @@ thread_select_idle(
                thread_quantum_init(thread);
                processor->quantum_end = processor->last_dispatch + thread->quantum_remaining;
                timer_call_enter1(&processor->quantum_timer, thread, processor->quantum_end, TIMER_CALL_SYS_CRITICAL | TIMER_CALL_LOCAL);
-               processor->timeslice = 1;
+               processor->first_timeslice = TRUE;
 
                thread->computation_epoch = processor->last_dispatch;
        }
 
        thread->state &= ~TH_IDLE;
 
-       /*
-        * If we idled in place, simulate a context switch back
-        * to the original priority of the thread so that the
-        * platform layer cannot distinguish this from a true
-        * switch to the idle thread.
-        */
-
        urgency = thread_get_urgency(thread, &arg1, &arg2);
 
-       thread_tell_urgency(urgency, arg1, arg2, new_thread);
+       thread_tell_urgency(urgency, arg1, arg2, 0, new_thread);
 
        sched_run_incr(thread);
-       if (thread->sched_mode == TH_MODE_TIMESHARE) {
-               sched_share_incr(thread);
-
-               if (thread->sched_flags & TH_SFLAG_THROTTLED)
-                       sched_background_incr(thread);
-       }
 
        return (new_thread);
 }
 #endif /* CONFIG_SCHED_IDLE_IN_PLACE */
 
-#if defined(CONFIG_SCHED_TRADITIONAL) 
-static thread_t
-sched_traditional_choose_thread(
-                                processor_t     processor,
-                                int             priority,
-                       __unused ast_t           reason)
-{
-       thread_t thread;
-       
-       thread = choose_thread_from_runq(processor, runq_for_processor(processor), priority);
-       if (thread != THREAD_NULL) {
-               runq_consider_decr_bound_count(processor, thread);
-       }
-       
-       return thread;
-}
-
-#endif /* defined(CONFIG_SCHED_TRADITIONAL)  */
-
-#if defined(CONFIG_SCHED_TRADITIONAL)
-
 /*
- *     choose_thread_from_runq:
- *
- *     Locate a thread to execute from the processor run queue
- *     and return it.  Only choose a thread with greater or equal
- *     priority.
+ * thread_invoke
  *
- *     Associated pset must be locked.  Returns THREAD_NULL
- *     on failure.
- */
-thread_t
-choose_thread_from_runq(
-       processor_t             processor,
-       run_queue_t             rq,
-       int                             priority)
-{
-       queue_t                 queue = rq->queues + rq->highq;
-       int                             pri = rq->highq, count = rq->count;
-       thread_t                thread;
-
-       while (count > 0 && pri >= priority) {
-               thread = (thread_t)queue_first(queue);
-               while (!queue_end(queue, (queue_entry_t)thread)) {
-                       if (thread->bound_processor == PROCESSOR_NULL ||
-                                                       thread->bound_processor == processor) {
-                               remqueue((queue_entry_t)thread);
-
-                               thread->runq = PROCESSOR_NULL;
-                               SCHED_STATS_RUNQ_CHANGE(&rq->runq_stats, rq->count);
-                               rq->count--;
-                               if (SCHED(priority_is_urgent)(pri)) {
-                                       rq->urgency--; assert(rq->urgency >= 0);
-                               }
-                               if (queue_empty(queue)) {
-                                       if (pri != IDLEPRI)
-                                               clrbit(MAXPRI - pri, rq->bitmap);
-                                       rq->highq = MAXPRI - ffsbit(rq->bitmap);
-                               }
-
-                               return (thread);
-                       }
-                       count--;
-
-                       thread = (thread_t)queue_next((queue_entry_t)thread);
-               }
-
-               queue--; pri--;
-       }
-
-       return (THREAD_NULL);
-}
-
-#endif /* defined(CONFIG_SCHED_TRADITIONAL) */
-
-/*
- *     Perform a context switch and start executing the new thread.
+ * Called at splsched with neither thread locked.
  *
- *     Returns FALSE on failure, and the thread is re-dispatched.
+ * Perform a context switch and start executing the new thread.
  *
- *     Called at splsched.
- */
-
-/*
- * thread_invoke
+ * Returns FALSE when the context switch didn't happen.
+ * The reference to the new thread is still consumed.
  *
  * "self" is what is currently running on the processor,
  * "thread" is the new thread to context switch to
@@ -2191,15 +2051,6 @@ thread_invoke(
        thread_t                        thread,
        ast_t                           reason)
 {
-       thread_continue_t       continuation = self->continuation;
-       void                    *parameter = self->parameter;
-       processor_t             processor;
-       uint64_t                ctime = mach_absolute_time();
-
-#ifdef CONFIG_MACH_APPROXIMATE_TIME
-       commpage_update_mach_approximate_time(ctime);
-#endif
-
        if (__improbable(get_preemption_level() != 0)) {
                int pl = get_preemption_level();
                panic("thread_invoke: preemption_level %d, possible cause: %s",
@@ -2207,33 +2058,39 @@ thread_invoke(
                        "blocking while holding a spinlock, or within interrupt context"));
        }
 
+       thread_continue_t       continuation = self->continuation;
+       void                    *parameter   = self->parameter;
+       processor_t             processor;
+
+       uint64_t                ctime = mach_absolute_time();
+
+#ifdef CONFIG_MACH_APPROXIMATE_TIME
+       commpage_update_mach_approximate_time(ctime);
+#endif
+
+#if defined(CONFIG_SCHED_TIMESHARE_CORE)
+       sched_timeshare_consider_maintenance(ctime);
+#endif
+
+       assert_thread_magic(self);
        assert(self == current_thread());
        assert(self->runq == PROCESSOR_NULL);
+       assert((self->state & (TH_RUN|TH_TERMINATE2)) == TH_RUN);
 
-#if defined(CONFIG_SCHED_TIMESHARE_CORE)
-       sched_traditional_consider_maintenance(ctime);
-#endif /* CONFIG_SCHED_TIMESHARE_CORE */       
-       
-       /*
-        * Mark thread interruptible.
-        */
        thread_lock(thread);
-       thread->state &= ~TH_UNINT;
 
-       assert(thread_runnable(thread));
+       assert_thread_magic(thread);
+       assert((thread->state & (TH_RUN|TH_WAIT|TH_UNINT|TH_TERMINATE|TH_TERMINATE2)) == TH_RUN);
        assert(thread->bound_processor == PROCESSOR_NULL || thread->bound_processor == current_processor());
        assert(thread->runq == PROCESSOR_NULL);
 
        /* Reload precise timing global policy to thread-local policy */
        thread->precise_user_kernel_time = use_precise_user_kernel_time(thread);
-       
+
        /* Update SFI class based on other factors */
        thread->sfi_class = sfi_thread_classify(thread);
 
-       /*
-        * Allow time constraint threads to hang onto
-        * a stack.
-        */
+       /* Allow realtime threads to hang onto a stack. */
        if ((self->sched_mode == TH_MODE_REALTIME) && !self->reserved_stack)
                self->reserved_stack = self->kernel_stack;
 
@@ -2266,6 +2123,7 @@ thread_invoke(
                        thread->last_processor = processor;
                        thread->c_switch++;
                        ast_context(thread);
+
                        thread_unlock(thread);
 
                        self->reason = reason;
@@ -2290,7 +2148,7 @@ thread_invoke(
                                self->reason, (uintptr_t)thread_tid(thread), self->sched_pri, thread->sched_pri, 0);
 
                        if ((thread->chosen_processor != processor) && (thread->chosen_processor != PROCESSOR_NULL)) {
-                               KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_SCHED, MACH_MOVED)|DBG_FUNC_NONE,
+                               SCHED_DEBUG_CHOOSE_PROCESSOR_KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_SCHED, MACH_MOVED)|DBG_FUNC_NONE,
                                                (uintptr_t)thread_tid(thread), (uintptr_t)thread->chosen_processor->cpu_id, 0, 0, 0);
                        }
 
@@ -2301,8 +2159,15 @@ thread_invoke(
                        TLOG(1, "thread_invoke: calling stack_handoff\n");
                        stack_handoff(self, thread);
 
+                       /* 'self' is now off core */
+                       assert(thread == current_thread());
+
                        DTRACE_SCHED(on__cpu);
 
+#if KPERF
+                       kperf_on_cpu(thread, continuation, NULL);
+#endif /* KPERF */
+
                        thread_dispatch(self, thread);
 
                        thread->continuation = thread->parameter = NULL;
@@ -2319,8 +2184,13 @@ thread_invoke(
                        /* same thread but with continuation */
                        ast_context(self);
                        counter(++c_thread_invoke_same);
+
                        thread_unlock(self);
 
+#if KPERF
+                       kperf_on_cpu(thread, continuation, NULL);
+#endif /* KPERF */
+
                        KERNEL_DEBUG_CONSTANT_IST(KDEBUG_TRACE,
                                MACHDBG_CODE(DBG_MACH_SCHED,MACH_SCHED) | DBG_FUNC_NONE,
                                self->reason, (uintptr_t)thread_tid(thread), self->sched_pri, thread->sched_pri, 0);
@@ -2332,8 +2202,7 @@ thread_invoke(
                        call_continuation(continuation, parameter, self->wait_result);
                        /*NOTREACHED*/
                }
-       }
-       else {
+       } else {
                /*
                 * Check that the other thread has a stack
                 */
@@ -2345,8 +2214,7 @@ need_stack:
                                thread_stack_enqueue(thread);
                                return (FALSE);
                        }
-               }
-               else if (thread == self) {
+               } else if (thread == self) {
                        ast_context(self);
                        counter(++c_thread_invoke_same);
                        thread_unlock(self);
@@ -2375,11 +2243,11 @@ need_stack:
        thread->last_processor = processor;
        thread->c_switch++;
        ast_context(thread);
+
        thread_unlock(thread);
 
        counter(c_thread_invoke_csw++);
 
-       assert(self->runq == PROCESSOR_NULL);
        self->reason = reason;
 
        processor->last_dispatch = ctime;
@@ -2396,13 +2264,13 @@ need_stack:
                                        ctime,
                                         PROCESSOR_DATA(processor, current_state));
        }
-       
+
        KERNEL_DEBUG_CONSTANT_IST(KDEBUG_TRACE,
                MACHDBG_CODE(DBG_MACH_SCHED,MACH_SCHED) | DBG_FUNC_NONE,
                self->reason, (uintptr_t)thread_tid(thread), self->sched_pri, thread->sched_pri, 0);
 
        if ((thread->chosen_processor != processor) && (thread->chosen_processor != NULL)) {
-               KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_SCHED, MACH_MOVED)|DBG_FUNC_NONE,
+               SCHED_DEBUG_CHOOSE_PROCESSOR_KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_SCHED, MACH_MOVED)|DBG_FUNC_NONE,
                                (uintptr_t)thread_tid(thread), (uintptr_t)thread->chosen_processor->cpu_id, 0, 0, 0);
        }
 
@@ -2414,6 +2282,16 @@ need_stack:
         * This is where we actually switch register context,
         * and address space if required.  We will next run
         * as a result of a subsequent context switch.
+        *
+        * Once registers are switched and the processor is running "thread",
+        * the stack variables and non-volatile registers will contain whatever
+        * was there the last time that thread blocked. No local variables should
+        * be used after this point, except for the special case of "thread", which
+        * the platform layer returns as the previous thread running on the processor
+        * via the function call ABI as a return register, and "self", which may have
+        * been stored on the stack or a non-volatile register, but a stale idea of
+        * what was on the CPU is newly-accurate because that thread is again
+        * running on the CPU.
         */
        assert(continuation == self->continuation);
        thread = machine_switch_context(self, continuation, thread);
@@ -2422,6 +2300,10 @@ need_stack:
 
        DTRACE_SCHED(on__cpu);
 
+#if KPERF
+       kperf_on_cpu(self, NULL, __builtin_frame_address(0));
+#endif /* KPERF */
+
        /*
         * We have been resumed and are set to run.
         */
@@ -2439,6 +2321,105 @@ need_stack:
        return (TRUE);
 }
 
+#if defined(CONFIG_SCHED_DEFERRED_AST)
+/*
+ *     pset_cancel_deferred_dispatch:
+ *
+ *     Cancels all ASTs that we can cancel for the given processor set
+ *     if the current processor is running the last runnable thread in the
+ *     system.
+ *
+ *     This function assumes the current thread is runnable.  This must
+ *     be called with the pset unlocked.
+ */
+static void
+pset_cancel_deferred_dispatch(
+       processor_set_t         pset,
+       processor_t             processor)
+{
+       processor_t             active_processor = NULL;
+       uint32_t                sampled_sched_run_count;
+
+       pset_lock(pset);
+       sampled_sched_run_count = (volatile uint32_t) sched_run_buckets[TH_BUCKET_RUN];
+
+       /*
+        * If we have emptied the run queue, and our current thread is runnable, we
+        * should tell any processors that are still DISPATCHING that they will
+        * probably not have any work to do.  In the event that there are no
+        * pending signals that we can cancel, this is also uninteresting.
+        *
+        * In the unlikely event that another thread becomes runnable while we are
+        * doing this (sched_run_count is atomically updated, not guarded), the
+        * codepath making it runnable SHOULD (a dangerous word) need the pset lock
+        * in order to dispatch it to a processor in our pset.  So, the other
+        * codepath will wait while we squash all cancelable ASTs, get the pset
+        * lock, and then dispatch the freshly runnable thread.  So this should be
+        * correct (we won't accidentally have a runnable thread that hasn't been
+        * dispatched to an idle processor), if not ideal (we may be restarting the
+        * dispatch process, which could have some overhead).
+        *
+        */
+       if ((sampled_sched_run_count == 1) &&
+           (pset->pending_deferred_AST_cpu_mask)) {
+               qe_foreach_element_safe(active_processor, &pset->active_queue, processor_queue) {
+                       /*
+                        * If a processor is DISPATCHING, it could be because of
+                        * a cancelable signal.
+                        *
+                        * IF the processor is not our
+                        * current processor (the current processor should not
+                        * be DISPATCHING, so this is a bit paranoid), AND there
+                        * is a cancelable signal pending on the processor, AND
+                        * there is no non-cancelable signal pending (as there is
+                        * no point trying to backtrack on bringing the processor
+                        * up if a signal we cannot cancel is outstanding), THEN
+                        * it should make sense to roll back the processor state
+                        * to the IDLE state.
+                        *
+                        * If the racey nature of this approach (as the signal
+                        * will be arbitrated by hardware, and can fire as we
+                        * roll back state) results in the core responding
+                        * despite being pushed back to the IDLE state, it
+                        * should be no different than if the core took some
+                        * interrupt while IDLE.
+                        */
+                       if ((active_processor->state == PROCESSOR_DISPATCHING) &&
+                           (pset->pending_deferred_AST_cpu_mask & (1ULL << active_processor->cpu_id)) &&
+                           (!(pset->pending_AST_cpu_mask & (1ULL << active_processor->cpu_id))) &&
+                           (active_processor != processor)) {
+                               /*
+                                * Squash all of the processor state back to some
+                                * reasonable facsimile of PROCESSOR_IDLE.
+                                *
+                                * TODO: What queue policy do we actually want here?
+                                * We want to promote selection of a good processor
+                                * to run on.  Do we want to enqueue at the head?
+                                * The tail?  At the (relative) old position in the
+                                * queue?  Or something else entirely?
+                                */
+                               re_queue_head(&pset->idle_queue, &active_processor->processor_queue);
+
+                               assert(active_processor->next_thread == THREAD_NULL);
+
+                               active_processor->current_pri = IDLEPRI;
+                               active_processor->current_thmode = TH_MODE_FIXED;
+                               active_processor->current_sfi_class = SFI_CLASS_KERNEL;
+                               active_processor->deadline = UINT64_MAX;
+                               active_processor->state = PROCESSOR_IDLE;
+                               pset->pending_deferred_AST_cpu_mask &= ~(1U << active_processor->cpu_id);
+                               machine_signal_idle_cancel(active_processor);
+                       }
+
+               }
+       }
+
+       pset_unlock(pset);
+}
+#else
+/* We don't support deferred ASTs; everything is candycanes and sunshine. */
+#endif
+
 /*
  *     thread_dispatch:
  *
@@ -2447,8 +2428,8 @@ need_stack:
  *     special actions.  Update quantum for other thread and begin
  *     the quantum for ourselves.
  *
- *     "self" is our new current thread that we have context switched
- *     to, "thread" is the old thread that we have switched away from.
+ *      "thread" is the old thread that we have switched away from.
+ *      "self" is the new current thread that we have context switched to
  *
  *     Called at splsched.
  */
@@ -2459,6 +2440,10 @@ thread_dispatch(
 {
        processor_t             processor = self->last_processor;
 
+       assert(processor == current_processor());
+       assert(self == current_thread());
+       assert(thread != self);
+
        if (thread != THREAD_NULL) {
                /*
                 *      If blocked at a continuation, discard
@@ -2467,7 +2452,12 @@ thread_dispatch(
                if (thread->continuation != NULL && thread->kernel_stack != 0)
                        stack_free(thread);
 
-               if (!(thread->state & TH_IDLE)) {
+               if (thread->state & TH_IDLE) {
+                       KERNEL_DEBUG_CONSTANT_IST(KDEBUG_TRACE,
+                               MACHDBG_CODE(DBG_MACH_SCHED,MACH_DISPATCH) | DBG_FUNC_NONE,
+                               (uintptr_t)thread_tid(thread), 0, thread->state,
+                               sched_run_buckets[TH_BUCKET_RUN], 0);
+               } else {
                        int64_t consumed;
                        int64_t remainder = 0;
 
@@ -2501,9 +2491,24 @@ thread_dispatch(
                        thread_lock(thread);
 
                        /*
-                        *      Compute remainder of current quantum.
+                        * Apply a priority floor if the thread holds a kernel resource
+                        * Do this before checking starting_pri to avoid overpenalizing
+                        * repeated rwlock blockers.
+                        */
+                       if (__improbable(thread->rwlock_count != 0))
+                               lck_rw_set_promotion_locked(thread);
+
+                       boolean_t keep_quantum = processor->first_timeslice;
+
+                       /*
+                        * Treat a thread which has dropped priority since it got on core
+                        * as having expired its quantum.
                         */
-                       if (first_timeslice(processor) &&
+                       if (processor->starting_pri > thread->sched_pri)
+                               keep_quantum = FALSE;
+
+                       /* Compute remainder of current quantum. */
+                       if (keep_quantum &&
                            processor->quantum_end > processor->last_dispatch)
                                thread->quantum_remaining = (uint32_t)remainder;
                        else
@@ -2518,7 +2523,7 @@ thread_dispatch(
                                        thread->realtime.deadline = UINT64_MAX;
                                }
                        } else {
-#if defined(CONFIG_SCHED_TRADITIONAL)
+#if defined(CONFIG_SCHED_TIMESHARE_CORE)
                                /*
                                 *      For non-realtime threads treat a tiny
                                 *      remaining quantum as an expired quantum
@@ -2528,7 +2533,7 @@ thread_dispatch(
                                        thread->reason |= AST_QUANTUM;
                                        thread->quantum_remaining += SCHED(initial_quantum_size)(thread);
                                }
-#endif
+#endif /* CONFIG_SCHED_TIMESHARE_CORE */
                        }
 
                        /*
@@ -2541,74 +2546,53 @@ thread_dispatch(
                                thread->quantum_remaining = 0;
                        } else {
 #if defined(CONFIG_SCHED_MULTIQ)
-                               if (sched_groups_enabled && thread->sched_group == self->sched_group) {
-                                       /* TODO: Remove tracepoint */
+                               if (SCHED(sched_groups_enabled) &&
+                                   thread->sched_group == self->sched_group) {
                                        KERNEL_DEBUG_CONSTANT_IST(KDEBUG_TRACE,
-                                           MACHDBG_CODE(DBG_MACH_SCHED, MACH_QUANTUM_HANDOFF) | DBG_FUNC_NONE,
+                                           MACHDBG_CODE(DBG_MACH_SCHED, MACH_QUANTUM_HANDOFF),
                                            self->reason, (uintptr_t)thread_tid(thread),
                                            self->quantum_remaining, thread->quantum_remaining, 0);
 
                                        self->quantum_remaining = thread->quantum_remaining;
                                        thread->quantum_remaining = 0;
-                                       /*  TODO: Should we set AST_QUANTUM here? */
+                                       /* Don't set AST_QUANTUM here - old thread might still want to preempt someone else */
                                }
 #endif /* defined(CONFIG_SCHED_MULTIQ) */
                        }
 
                        thread->computation_metered += (processor->last_dispatch - thread->computation_epoch);
 
-                       if ((thread->rwlock_count != 0) && !(LcksOpts & disLkRWPrio)) {
-                               integer_t priority;
-
-                               priority = thread->sched_pri;
-
-                               if (priority < thread->priority)
-                                       priority = thread->priority;
-                               if (priority < BASEPRI_BACKGROUND)
-                                       priority = BASEPRI_BACKGROUND;
-
-                               if ((thread->sched_pri < priority) || !(thread->sched_flags & TH_SFLAG_RW_PROMOTED)) {
-                                       KERNEL_DEBUG_CONSTANT(
-                                               MACHDBG_CODE(DBG_MACH_SCHED, MACH_RW_PROMOTE) | DBG_FUNC_NONE,
-                                               (uintptr_t)thread_tid(thread), thread->sched_pri, thread->priority, priority, 0);
-
-                                       thread->sched_flags |= TH_SFLAG_RW_PROMOTED;
-
-                                       if (thread->sched_pri < priority)
-                                               set_sched_pri(thread, priority);
-                               }
-                       }
-
                        if (!(thread->state & TH_WAIT)) {
                                /*
-                                *      Still running.
+                                *      Still runnable.
                                 */
+                               thread->last_made_runnable_time = mach_approximate_time();
+
+                               machine_thread_going_off_core(thread, FALSE);
+
                                if (thread->reason & AST_QUANTUM)
                                        thread_setrun(thread, SCHED_TAILQ);
-                               else
-                               if (thread->reason & AST_PREEMPT)
+                               else if (thread->reason & AST_PREEMPT)
                                        thread_setrun(thread, SCHED_HEADQ);
                                else
                                        thread_setrun(thread, SCHED_PREEMPT | SCHED_TAILQ);
 
-                               thread->reason = AST_NONE;
-
                                KERNEL_DEBUG_CONSTANT_IST(KDEBUG_TRACE,
-                                       MACHDBG_CODE(DBG_MACH_SCHED,MACH_DISPATCH) | DBG_FUNC_NONE,
-                                       (uintptr_t)thread_tid(thread), thread->reason, thread->state, sched_run_count, 0);
-                               
+                                       MACHDBG_CODE(DBG_MACH_SCHED,MACH_DISPATCH) | DBG_FUNC_NONE,
+                                       (uintptr_t)thread_tid(thread), thread->reason, thread->state,
+                                       sched_run_buckets[TH_BUCKET_RUN], 0);
+
                                if (thread->wake_active) {
                                        thread->wake_active = FALSE;
                                        thread_unlock(thread);
 
                                        thread_wakeup(&thread->wake_active);
-                               }
-                               else
+                               } else {
                                        thread_unlock(thread);
+                               }
 
                                wake_unlock(thread);
-                       }
-                       else {
+                       } else {
                                /*
                                 *      Waiting.
                                 */
@@ -2625,25 +2609,25 @@ thread_dispatch(
                                }
 
                                thread->state &= ~TH_RUN;
+                               thread->last_made_runnable_time = ~0ULL;
                                thread->chosen_processor = PROCESSOR_NULL;
 
-                               if (thread->sched_mode == TH_MODE_TIMESHARE) {
-                                       if (thread->sched_flags & TH_SFLAG_THROTTLED)
-                                               sched_background_decr(thread);
-
-                                       sched_share_decr(thread);
-                               }
                                new_run_count = sched_run_decr(thread);
 
+#if CONFIG_SCHED_SFI
                                if ((thread->state & (TH_WAIT | TH_TERMINATE)) == TH_WAIT) {
                                        if (thread->reason & AST_SFI) {
                                                thread->wait_sfi_begin_time = processor->last_dispatch;
                                        }
                                }
+#endif
+
+                               machine_thread_going_off_core(thread, should_terminate);
 
                                KERNEL_DEBUG_CONSTANT_IST(KDEBUG_TRACE,
-                                       MACHDBG_CODE(DBG_MACH_SCHED,MACH_DISPATCH) | DBG_FUNC_NONE,
-                                       (uintptr_t)thread_tid(thread), thread->reason, thread->state, new_run_count, 0);
+                                       MACHDBG_CODE(DBG_MACH_SCHED,MACH_DISPATCH) | DBG_FUNC_NONE,
+                                       (uintptr_t)thread_tid(thread), thread->reason, thread->state,
+                                       new_run_count, 0);
 
                                (*thread->sched_call)(SCHED_CALL_BLOCK, thread);
 
@@ -2652,9 +2636,9 @@ thread_dispatch(
                                        thread_unlock(thread);
 
                                        thread_wakeup(&thread->wake_active);
-                               }
-                               else
+                               } else {
                                        thread_unlock(thread);
+                               }
 
                                wake_unlock(thread);
 
@@ -2664,22 +2648,31 @@ thread_dispatch(
                }
        }
 
+       /* Update (new) current thread and reprogram quantum timer */
+       thread_lock(self);
        if (!(self->state & TH_IDLE)) {
                uint64_t        arg1, arg2;
                int             urgency;
+               uint64_t                latency;
+
+#if CONFIG_SCHED_SFI
                ast_t                   new_ast;
 
-               thread_lock(self);
                new_ast = sfi_thread_needs_ast(self, NULL);
-               thread_unlock(self);
 
                if (new_ast != AST_NONE) {
                        ast_on(new_ast);
                }
+#endif
+
+               assertf(processor->last_dispatch >= self->last_made_runnable_time, "Non-monotonic time? dispatch at 0x%llx, runnable at 0x%llx", processor->last_dispatch, self->last_made_runnable_time);
+               latency = processor->last_dispatch - self->last_made_runnable_time;
 
                urgency = thread_get_urgency(self, &arg1, &arg2);
 
-               thread_tell_urgency(urgency, arg1, arg2, self);
+               thread_tell_urgency(urgency, arg1, arg2, latency, self);
+
+               machine_thread_going_on_core(self, urgency, latency);
                
                /*
                 *      Get a new quantum if none remaining.
@@ -2694,16 +2687,32 @@ thread_dispatch(
                processor->quantum_end = processor->last_dispatch + self->quantum_remaining;
                timer_call_enter1(&processor->quantum_timer, self, processor->quantum_end, TIMER_CALL_SYS_CRITICAL | TIMER_CALL_LOCAL);
 
-               processor->timeslice = 1;
+               processor->first_timeslice = TRUE;
+       } else {
+               timer_call_cancel(&processor->quantum_timer);
+               processor->first_timeslice = FALSE;
 
-               self->computation_epoch = processor->last_dispatch;
+               thread_tell_urgency(THREAD_URGENCY_NONE, 0, 0, 0, self);
+               machine_thread_going_on_core(self, THREAD_URGENCY_NONE, 0);
        }
-       else {
-               timer_call_cancel(&processor->quantum_timer);
-               processor->timeslice = 0;
 
-               thread_tell_urgency(THREAD_URGENCY_NONE, 0, 0, NULL);
+       self->computation_epoch = processor->last_dispatch;
+       self->reason = AST_NONE;
+       processor->starting_pri = self->sched_pri;
+
+       thread_unlock(self);
+
+#if defined(CONFIG_SCHED_DEFERRED_AST)
+       /*
+        * TODO: Can we state that redispatching our old thread is also
+        * uninteresting?
+        */
+       if ((((volatile uint32_t)sched_run_buckets[TH_BUCKET_RUN]) == 1) &&
+           !(self->state & TH_IDLE)) {
+               pset_cancel_deferred_dispatch(processor->processor_set, processor);
        }
+#endif
+
 }
 
 /*
@@ -2725,10 +2734,10 @@ thread_block_reason(
        void                            *parameter,
        ast_t                           reason)
 {
-       register thread_t               self = current_thread();
-       register processor_t    processor;
-       register thread_t               new_thread;
-       spl_t                                   s;
+       thread_t        self = current_thread();
+       processor_t     processor;
+       thread_t        new_thread;
+       spl_t           s;
 
        counter(++c_thread_block_calls);
 
@@ -2738,11 +2747,19 @@ thread_block_reason(
 
        /* If we're explicitly yielding, force a subsequent quantum */
        if (reason & AST_YIELD)
-               processor->timeslice = 0;
+               processor->first_timeslice = FALSE;
 
        /* We're handling all scheduling AST's */
        ast_off(AST_SCHEDULING);
 
+#if PROC_REF_DEBUG
+       if ((continuation != NULL) && (self->task != kernel_task)) {
+               if (uthread_get_proc_refcount(self->uthread) != 0) {
+                       panic("thread_block_reason with continuation uthread %p with uu_proc_refcount != 0", self->uthread);
+               }
+       }
+#endif
+
        self->continuation = continuation;
        self->parameter = parameter;
 
@@ -2825,17 +2842,21 @@ thread_run(
  */
 void
 thread_continue(
-       register thread_t       thread)
+       thread_t        thread)
 {
-       register thread_t               self = current_thread();
-       register thread_continue_t      continuation;
-       register void                   *parameter;
+       thread_t                self = current_thread();
+       thread_continue_t       continuation;
+       void                    *parameter;
 
        DTRACE_SCHED(on__cpu);
 
        continuation = self->continuation;
        parameter = self->parameter;
 
+#if KPERF
+       kperf_on_cpu(self, continuation, NULL);
+#endif
+
        thread_dispatch(thread, self);
 
        self->continuation = self->parameter = NULL;
@@ -2858,32 +2879,15 @@ thread_quantum_init(thread_t thread)
        }
 }
 
-#if defined(CONFIG_SCHED_TIMESHARE_CORE)
-
 uint32_t
-sched_traditional_initial_quantum_size(thread_t thread)
+sched_timeshare_initial_quantum_size(thread_t thread)
 {
-       if ((thread == THREAD_NULL) || !(thread->sched_flags & TH_SFLAG_THROTTLED))
-               return std_quantum;
-       else
+       if ((thread != THREAD_NULL) && thread->th_sched_bucket == TH_BUCKET_SHARE_BG)
                return bg_quantum;
-}
-
-#endif /* CONFIG_SCHED_TIMESHARE_CORE */
-
-#if defined(CONFIG_SCHED_TRADITIONAL)
-
-static sched_mode_t
-sched_traditional_initial_thread_sched_mode(task_t parent_task)
-{
-       if (parent_task == kernel_task)
-               return TH_MODE_FIXED;
        else
-               return TH_MODE_TIMESHARE;
+               return std_quantum;
 }
 
-#endif /* CONFIG_SCHED_TRADITIONAL */
-
 /*
  *     run_queue_init:
  *
@@ -2893,98 +2897,14 @@ void
 run_queue_init(
        run_queue_t             rq)
 {
-       int                             i;
-
-       rq->highq = IDLEPRI;
-       for (i = 0; i < NRQBM; i++)
+       rq->highq = NOPRI;
+       for (u_int i = 0; i < BITMAP_LEN(NRQS); i++)
                rq->bitmap[i] = 0;
-       setbit(MAXPRI - IDLEPRI, rq->bitmap);
        rq->urgency = rq->count = 0;
-       for (i = 0; i < NRQS; i++)
+       for (int i = 0; i < NRQS; i++)
                queue_init(&rq->queues[i]);
 }
 
-#if defined(CONFIG_SCHED_FAIRSHARE_CORE)
-int
-sched_traditional_fairshare_runq_count(void)
-{
-       return fs_runq.count;
-}
-
-uint64_t
-sched_traditional_fairshare_runq_stats_count_sum(void)
-{
-       return fs_runq.runq_stats.count_sum;
-}
-
-void
-sched_traditional_fairshare_enqueue(thread_t thread)
-{
-       queue_t                         queue = &fs_runq.queue;
-       
-       simple_lock(&fs_lock);
-       
-       enqueue_tail(queue, (queue_entry_t)thread);
-       
-       thread->runq = FS_RUNQ;
-       SCHED_STATS_RUNQ_CHANGE(&fs_runq.runq_stats, fs_runq.count);
-       fs_runq.count++;
-       
-       simple_unlock(&fs_lock);        
-}
-
-thread_t
-sched_traditional_fairshare_dequeue(void)
-{
-       thread_t thread;
-       
-       simple_lock(&fs_lock);
-       if (fs_runq.count > 0) {
-               thread = (thread_t)dequeue_head(&fs_runq.queue);
-               
-               thread->runq = PROCESSOR_NULL;
-               SCHED_STATS_RUNQ_CHANGE(&fs_runq.runq_stats, fs_runq.count);
-               fs_runq.count--;
-               
-               simple_unlock(&fs_lock);
-               
-               return (thread);
-       }
-       simple_unlock(&fs_lock);                
-
-       return THREAD_NULL;
-}
-
-boolean_t
-sched_traditional_fairshare_queue_remove(thread_t thread)
-{
-       queue_t                 q;
-
-       simple_lock(&fs_lock);
-       q = &fs_runq.queue;
-       
-       if (FS_RUNQ == thread->runq) {
-               remqueue((queue_entry_t)thread);
-               SCHED_STATS_RUNQ_CHANGE(&fs_runq.runq_stats, fs_runq.count);
-               fs_runq.count--;
-               
-               thread->runq = PROCESSOR_NULL;
-               simple_unlock(&fs_lock);
-               return (TRUE);
-       }
-       else {
-               /*
-                *      The thread left the run queue before we could
-                *      lock the run queue.
-                */
-               assert(thread->runq == PROCESSOR_NULL);
-               simple_unlock(&fs_lock);
-               return (FALSE);
-       }       
-}
-
-#endif /* CONFIG_SCHED_FAIRSHARE_CORE */
-
 /*
  *     run_queue_dequeue:
  *
@@ -2996,19 +2916,21 @@ sched_traditional_fairshare_queue_remove(thread_t thread)
  */
 thread_t
 run_queue_dequeue(
-       run_queue_t             rq,
-       integer_t               options)
+                  run_queue_t   rq,
+                  integer_t     options)
 {
-       thread_t                thread;
-       queue_t                 queue = rq->queues + rq->highq;
+       thread_t    thread;
+       queue_t     queue = &rq->queues[rq->highq];
 
        if (options & SCHED_HEADQ) {
-               thread = (thread_t)dequeue_head(queue);
-       }
-       else {
-               thread = (thread_t)dequeue_tail(queue);
+               thread = qe_dequeue_head(queue, struct thread, runq_links);
+       } else {
+               thread = qe_dequeue_tail(queue, struct thread, runq_links);
        }
 
+       assert(thread != THREAD_NULL);
+       assert_thread_magic(thread);
+
        thread->runq = PROCESSOR_NULL;
        SCHED_STATS_RUNQ_CHANGE(&rq->runq_stats, rq->count);
        rq->count--;
@@ -3016,12 +2938,11 @@ run_queue_dequeue(
                rq->urgency--; assert(rq->urgency >= 0);
        }
        if (queue_empty(queue)) {
-               if (rq->highq != IDLEPRI)
-                       clrbit(MAXPRI - rq->highq, rq->bitmap);
-               rq->highq = MAXPRI - ffsbit(rq->bitmap);
+               bitmap_clear(rq->bitmap, rq->highq);
+               rq->highq = bitmap_first(rq->bitmap, NRQS);
        }
 
-       return (thread);
+       return thread;
 }
 
 /*
@@ -3034,34 +2955,35 @@ run_queue_dequeue(
  */
 boolean_t
 run_queue_enqueue(
-                                                         run_queue_t           rq,
-                                                         thread_t                      thread,
-                                                         integer_t             options)
+                  run_queue_t   rq,
+                  thread_t      thread,
+                  integer_t     options)
 {
-       queue_t                 queue = rq->queues + thread->sched_pri;
-       boolean_t               result = FALSE;
-       
+       queue_t     queue = &rq->queues[thread->sched_pri];
+       boolean_t   result = FALSE;
+
+       assert_thread_magic(thread);
+
        if (queue_empty(queue)) {
-               enqueue_tail(queue, (queue_entry_t)thread);
-               
-               setbit(MAXPRI - thread->sched_pri, rq->bitmap);
+               enqueue_tail(queue, &thread->runq_links);
+
+               rq_bitmap_set(rq->bitmap, thread->sched_pri);
                if (thread->sched_pri > rq->highq) {
                        rq->highq = thread->sched_pri;
                        result = TRUE;
                }
        } else {
                if (options & SCHED_TAILQ)
-                       enqueue_tail(queue, (queue_entry_t)thread);
+                       enqueue_tail(queue, &thread->runq_links);
                else
-                       enqueue_head(queue, (queue_entry_t)thread);
+                       enqueue_head(queue, &thread->runq_links);
        }
        if (SCHED(priority_is_urgent)(thread->sched_pri))
                rq->urgency++;
        SCHED_STATS_RUNQ_CHANGE(&rq->runq_stats, rq->count);
        rq->count++;
-       
+
        return (result);
-       
 }
 
 /*
@@ -3073,97 +2995,90 @@ run_queue_enqueue(
  */
 void
 run_queue_remove(
-                                 run_queue_t           rq,
-                                 thread_t                      thread)
+                 run_queue_t    rq,
+                 thread_t       thread)
 {
+       assert(thread->runq != PROCESSOR_NULL);
+       assert_thread_magic(thread);
 
-       remqueue((queue_entry_t)thread);
+       remqueue(&thread->runq_links);
        SCHED_STATS_RUNQ_CHANGE(&rq->runq_stats, rq->count);
        rq->count--;
        if (SCHED(priority_is_urgent)(thread->sched_pri)) {
                rq->urgency--; assert(rq->urgency >= 0);
        }
-       
-       if (queue_empty(rq->queues + thread->sched_pri)) {
+
+       if (queue_empty(&rq->queues[thread->sched_pri])) {
                /* update run queue status */
-               if (thread->sched_pri != IDLEPRI)
-                       clrbit(MAXPRI - thread->sched_pri, rq->bitmap);
-               rq->highq = MAXPRI - ffsbit(rq->bitmap);
+               bitmap_clear(rq->bitmap, thread->sched_pri);
+               rq->highq = bitmap_first(rq->bitmap, NRQS);
        }
-       
+
        thread->runq = PROCESSOR_NULL;
 }
 
-/*
- *     fairshare_setrun:
- *
- *     Dispatch a thread for round-robin execution.
- *
- *     Thread must be locked.  Associated pset must
- *     be locked, and is returned unlocked.
- */
-static void
-fairshare_setrun(
-                                 processor_t                   processor,
-                                 thread_t                      thread)
+/* Assumes RT lock is not held, and acquires splsched/rt_lock itself */
+void
+rt_runq_scan(sched_update_scan_context_t scan_context)
 {
-       processor_set_t         pset = processor->processor_set;
-               
-       thread->chosen_processor = processor;
-
-       SCHED(fairshare_enqueue)(thread);
-       
-       pset_unlock(pset);
+       spl_t           s;
+       thread_t        thread;
 
-       if (processor != current_processor())
-               machine_signal_idle(processor);
+       s = splsched();
+       rt_lock_lock();
 
+       qe_foreach_element_safe(thread, &rt_runq.queue, runq_links) {
+               if (thread->last_made_runnable_time < scan_context->earliest_rt_make_runnable_time) {
+                       scan_context->earliest_rt_make_runnable_time = thread->last_made_runnable_time;
+               }
+       }
 
+       rt_lock_unlock();
+       splx(s);
 }
 
+
 /*
  *     realtime_queue_insert:
  *
  *     Enqueue a thread for realtime execution.
  */
 static boolean_t
-realtime_queue_insert(
-       thread_t                        thread)
+realtime_queue_insert(thread_t thread)
 {
-       queue_t                         queue = &rt_runq.queue;
-       uint64_t                        deadline = thread->realtime.deadline;
-       boolean_t                       preempt = FALSE;
+       queue_t     queue       = &rt_runq.queue;
+       uint64_t    deadline    = thread->realtime.deadline;
+       boolean_t   preempt     = FALSE;
 
-       simple_lock(&rt_lock);
+       rt_lock_lock();
 
        if (queue_empty(queue)) {
-               enqueue_tail(queue, (queue_entry_t)thread);
+               enqueue_tail(queue, &thread->runq_links);
                preempt = TRUE;
-       }
-       else {
-               register thread_t       entry = (thread_t)queue_first(queue);
-
-               while (TRUE) {
-                       if (    queue_end(queue, (queue_entry_t)entry)  ||
-                                               deadline < entry->realtime.deadline             ) {
-                               entry = (thread_t)queue_prev((queue_entry_t)entry);
+       } else {
+               /* Insert into rt_runq in thread deadline order */
+               queue_entry_t iter;
+               qe_foreach(iter, queue) {
+                       thread_t iter_thread = qe_element(iter, struct thread, runq_links);
+                       assert_thread_magic(iter_thread);
+
+                       if (deadline < iter_thread->realtime.deadline) {
+                               if (iter == queue_first(queue))
+                                       preempt = TRUE;
+                               insque(&thread->runq_links, queue_prev(iter));
+                               break;
+                       } else if (iter == queue_last(queue)) {
+                               enqueue_tail(queue, &thread->runq_links);
                                break;
                        }
-
-                       entry = (thread_t)queue_next((queue_entry_t)entry);
                }
-
-               if ((queue_entry_t)entry == queue)
-                       preempt = TRUE;
-
-               insque((queue_entry_t)thread, (queue_entry_t)entry);
        }
 
-       thread->runq = RT_RUNQ;
+       thread->runq = THREAD_ON_RT_RUNQ;
        SCHED_STATS_RUNQ_CHANGE(&rt_runq.runq_stats, rt_runq.count);
        rt_runq.count++;
 
-       simple_unlock(&rt_lock);
+       rt_lock_unlock();
 
        return (preempt);
 }
@@ -3196,8 +3111,7 @@ realtime_setrun(
         */
        if ( (thread->bound_processor == processor)
                && processor->state == PROCESSOR_IDLE) {
-               remqueue((queue_entry_t)processor);
-               enqueue_tail(&pset->active_queue, (queue_entry_t)processor);
+               re_queue_tail(&pset->active_queue, &processor->processor_queue);
 
                processor->next_thread = thread;
                processor->current_pri = thread->sched_pri;
@@ -3207,9 +3121,9 @@ realtime_setrun(
                processor->state = PROCESSOR_DISPATCHING;
 
                if (processor != current_processor()) {
-                       if (!(pset->pending_AST_cpu_mask & (1U << processor->cpu_id))) {
+                       if (!(pset->pending_AST_cpu_mask & (1ULL << processor->cpu_id))) {
                                /* cleared on exit from main processor_idle() loop */
-                               pset->pending_AST_cpu_mask |= (1U << processor->cpu_id);
+                               pset->pending_AST_cpu_mask |= (1ULL << processor->cpu_id);
                                do_signal_idle = TRUE;
                        }
                }
@@ -3232,8 +3146,8 @@ realtime_setrun(
 
        if (preempt != AST_NONE) {
                if (processor->state == PROCESSOR_IDLE) {
-                       remqueue((queue_entry_t)processor);
-                       enqueue_tail(&pset->active_queue, (queue_entry_t)processor);
+                       re_queue_tail(&pset->active_queue, &processor->processor_queue);
+
                        processor->next_thread = THREAD_NULL;
                        processor->current_pri = thread->sched_pri;
                        processor->current_thmode = thread->sched_mode;
@@ -3243,9 +3157,9 @@ realtime_setrun(
                        if (processor == current_processor()) {
                                ast_on(preempt);
                        } else {
-                               if (!(pset->pending_AST_cpu_mask & (1U << processor->cpu_id))) {
+                               if (!(pset->pending_AST_cpu_mask & (1ULL << processor->cpu_id))) {
                                        /* cleared on exit from main processor_idle() loop */
-                                       pset->pending_AST_cpu_mask |= (1U << processor->cpu_id);
+                                       pset->pending_AST_cpu_mask |= (1ULL << processor->cpu_id);
                                        do_signal_idle = TRUE;
                                }
                        }
@@ -3260,9 +3174,9 @@ realtime_setrun(
                        if (processor == current_processor()) {
                                ast_on(preempt);
                        } else {
-                               if (!(pset->pending_AST_cpu_mask & (1U << processor->cpu_id))) {
+                               if (!(pset->pending_AST_cpu_mask & (1ULL << processor->cpu_id))) {
                                        /* cleared after IPI causes csw_check() to be called */
-                                       pset->pending_AST_cpu_mask |= (1U << processor->cpu_id);
+                                       pset->pending_AST_cpu_mask |= (1ULL << processor->cpu_id);
                                        do_cause_ast = TRUE;
                                }
                        }
@@ -3286,42 +3200,11 @@ realtime_setrun(
 boolean_t
 priority_is_urgent(int priority)
 {
-       return testbit(priority, sched_preempt_pri) ? TRUE : FALSE;
+       return bitmap_test(sched_preempt_pri, priority) ? TRUE : FALSE;
 }
 
 #endif /* CONFIG_SCHED_TIMESHARE_CORE */
 
-#if defined(CONFIG_SCHED_TRADITIONAL)
-/*
- *     processor_enqueue:
- *
- *     Enqueue thread on a processor run queue.  Thread must be locked,
- *     and not already be on a run queue.
- *
- *     Returns TRUE if a preemption is indicated based on the state
- *     of the run queue.
- *
- *     The run queue must be locked (see thread_run_queue_remove()
- *     for more info).
- */
-static boolean_t
-processor_enqueue(
-       processor_t             processor,
-       thread_t                thread,
-       integer_t               options)
-{
-       run_queue_t             rq = runq_for_processor(processor);
-       boolean_t               result;
-       
-       result = run_queue_enqueue(rq, thread, options);
-       thread->runq = processor;
-       runq_consider_incr_bound_count(processor, thread);
-
-       return (result);
-}
-
-#endif /* CONFIG_SCHED_TRADITIONAL */
-
 /*
  *     processor_setrun:
  *
@@ -3340,8 +3223,9 @@ processor_setrun(
        processor_set_t         pset = processor->processor_set;
        ast_t                           preempt;
        enum { eExitIdle, eInterruptRunning, eDoNothing } ipi_action = eDoNothing;
+       enum { eNoSignal, eDoSignal, eDoDeferredSignal } do_signal_idle = eNoSignal;
 
-       boolean_t do_signal_idle = FALSE, do_cause_ast = FALSE;
+       boolean_t do_cause_ast = FALSE;
 
        thread->chosen_processor = processor;
 
@@ -3351,8 +3235,8 @@ processor_setrun(
        if ( (SCHED(direct_dispatch_to_idle_processors) ||
                  thread->bound_processor == processor)
                && processor->state == PROCESSOR_IDLE) {
-               remqueue((queue_entry_t)processor);
-               enqueue_tail(&pset->active_queue, (queue_entry_t)processor);
+
+               re_queue_tail(&pset->active_queue, &processor->processor_queue);
 
                processor->next_thread = thread;
                processor->current_pri = thread->sched_pri;
@@ -3361,14 +3245,15 @@ processor_setrun(
                processor->deadline = UINT64_MAX;
                processor->state = PROCESSOR_DISPATCHING;
 
-               if (!(pset->pending_AST_cpu_mask & (1U << processor->cpu_id))) {
+               if (!(pset->pending_AST_cpu_mask & (1ULL << processor->cpu_id))) {
                        /* cleared on exit from main processor_idle() loop */
-                       pset->pending_AST_cpu_mask |= (1U << processor->cpu_id);
-                       do_signal_idle = TRUE;
+                       pset->pending_AST_cpu_mask |= (1ULL << processor->cpu_id);
+                       do_signal_idle = eDoSignal;
                }
 
                pset_unlock(pset);
-               if (do_signal_idle) {
+
+               if (do_signal_idle == eDoSignal) {
                        machine_signal_idle(processor);
                }
 
@@ -3378,12 +3263,15 @@ processor_setrun(
        /*
         *      Set preemption mode.
         */
+#if defined(CONFIG_SCHED_DEFERRED_AST)
+       /* TODO: Do we need to care about urgency (see rdar://problem/20136239)? */
+#endif
        if (SCHED(priority_is_urgent)(thread->sched_pri) && thread->sched_pri > processor->current_pri)
                preempt = (AST_PREEMPT | AST_URGENT);
        else if(processor->active_thread && thread_eager_preemption(processor->active_thread))
                preempt = (AST_PREEMPT | AST_URGENT);
-       else if ((thread->sched_mode == TH_MODE_TIMESHARE) && (thread->sched_pri < thread->priority)) {
-               if(SCHED(priority_is_urgent)(thread->priority) && thread->sched_pri > processor->current_pri) {
+       else if ((thread->sched_mode == TH_MODE_TIMESHARE) && (thread->sched_pri < thread->base_pri)) {
+               if(SCHED(priority_is_urgent)(thread->base_pri) && thread->sched_pri > processor->current_pri) {
                        preempt = (options & SCHED_PREEMPT)? AST_PREEMPT: AST_NONE;
                } else {
                        preempt = AST_NONE;
@@ -3395,8 +3283,8 @@ processor_setrun(
 
        if (preempt != AST_NONE) {
                if (processor->state == PROCESSOR_IDLE) {
-                       remqueue((queue_entry_t)processor);
-                       enqueue_tail(&pset->active_queue, (queue_entry_t)processor);
+                       re_queue_tail(&pset->active_queue, &processor->processor_queue);
+
                        processor->next_thread = THREAD_NULL;
                        processor->current_pri = thread->sched_pri;
                        processor->current_thmode = thread->sched_mode;
@@ -3414,8 +3302,7 @@ processor_setrun(
                        }
                } else if (     (processor->state == PROCESSOR_RUNNING          ||
                                 processor->state == PROCESSOR_SHUTDOWN)                &&
-                               (thread->sched_pri >= processor->current_pri    ||
-                               processor->current_thmode == TH_MODE_FAIRSHARE)) {
+                               (thread->sched_pri >= processor->current_pri)) {
                        ipi_action = eInterruptRunning;
                }
        } else {
@@ -3428,8 +3315,8 @@ processor_setrun(
                        ipi_action = eInterruptRunning;
                } else if (     processor->state == PROCESSOR_IDLE      &&
                                        processor != current_processor()        ) {
-                       remqueue((queue_entry_t)processor);
-                       enqueue_tail(&pset->active_queue, (queue_entry_t)processor);
+                       re_queue_tail(&pset->active_queue, &processor->processor_queue);
+
                        processor->next_thread = THREAD_NULL;
                        processor->current_pri = thread->sched_pri;
                        processor->current_thmode = thread->sched_mode;
@@ -3449,11 +3336,20 @@ processor_setrun(
                                if (csw_check_locked(processor, pset, AST_NONE) != AST_NONE)
                                        ast_on(preempt);
                        } else {
-                               if (!(pset->pending_AST_cpu_mask & (1U << processor->cpu_id))) {
+#if defined(CONFIG_SCHED_DEFERRED_AST)
+                               if (!(pset->pending_deferred_AST_cpu_mask & (1ULL << processor->cpu_id)) &&
+                                   !(pset->pending_AST_cpu_mask & (1ULL << processor->cpu_id))) {
                                        /* cleared on exit from main processor_idle() loop */
-                                       pset->pending_AST_cpu_mask |= (1U << processor->cpu_id);
-                                       do_signal_idle = TRUE;
+                                       pset->pending_deferred_AST_cpu_mask |= (1ULL << processor->cpu_id);
+                                       do_signal_idle = eDoDeferredSignal;
                                }
+#else
+                               if (!(pset->pending_AST_cpu_mask & (1ULL << processor->cpu_id))) {
+                                       /* cleared on exit from main processor_idle() loop */
+                                       pset->pending_AST_cpu_mask |= (1ULL << processor->cpu_id);
+                                       do_signal_idle = eDoSignal;
+                               }
+#endif
                        }
                        break;
                case eInterruptRunning:
@@ -3461,9 +3357,9 @@ processor_setrun(
                                if (csw_check_locked(processor, pset, AST_NONE) != AST_NONE)
                                        ast_on(preempt);
                        } else {
-                               if (!(pset->pending_AST_cpu_mask & (1U << processor->cpu_id))) {
+                               if (!(pset->pending_AST_cpu_mask & (1ULL << processor->cpu_id))) {
                                        /* cleared after IPI causes csw_check() to be called */
-                                       pset->pending_AST_cpu_mask |= (1U << processor->cpu_id);
+                                       pset->pending_AST_cpu_mask |= (1ULL << processor->cpu_id);
                                        do_cause_ast = TRUE;
                                }
                        }
@@ -3472,120 +3368,29 @@ processor_setrun(
 
        pset_unlock(pset);
 
-       if (do_signal_idle) {
+       if (do_signal_idle == eDoSignal) {
                machine_signal_idle(processor);
-       } else if (do_cause_ast) {
-               cause_ast_check(processor);
        }
-}
-
-#if defined(CONFIG_SCHED_TRADITIONAL)
-
-static boolean_t
-processor_queue_empty(processor_t              processor)
-{
-       return runq_for_processor(processor)->count == 0;
-       
-}
-
-static boolean_t
-sched_traditional_with_pset_runqueue_processor_queue_empty(processor_t         processor)
-{
-       processor_set_t pset = processor->processor_set;
-       int count = runq_for_processor(processor)->count;
-
-       /*
-        * The pset runq contains the count of all runnable threads
-        * for all processors in the pset. However, for threads that
-        * are bound to another processor, the current "processor"
-        * is not eligible to execute the thread. So we only
-        * include bound threads that our bound to the current
-        * "processor". This allows the processor to idle when the
-        * count of eligible threads drops to 0, even if there's
-        * a runnable thread bound to a different processor in the
-        * shared runq.
-        */
-
-       count -= pset->pset_runq_bound_count;
-       count += processor->runq_bound_count;
-
-       return count == 0;
-}
-
-static ast_t
-processor_csw_check(processor_t processor)
-{
-       run_queue_t             runq;
-       boolean_t               has_higher;
-
-       assert(processor->active_thread != NULL);
-       
-       runq = runq_for_processor(processor);
-       if (first_timeslice(processor)) {
-               has_higher = (runq->highq > processor->current_pri);
-       } else {
-               has_higher = (runq->highq >= processor->current_pri);
+#if defined(CONFIG_SCHED_DEFERRED_AST)
+       else if (do_signal_idle == eDoDeferredSignal) {
+               /*
+                * TODO: The ability to cancel this signal could make
+                * sending it outside of the pset lock an issue.  Do
+                * we need to address this?  Or would the only fallout
+                * be that the core takes a signal?  As long as we do
+                * not run the risk of having a core marked as signal
+                * outstanding, with no real signal outstanding, the
+                * only result should be that we fail to cancel some
+                * signals.
+                */
+               machine_signal_idle_deferred(processor);
        }
-       if (has_higher) {
-               if (runq->urgency > 0)
-                       return (AST_PREEMPT | AST_URGENT);
-               
-               if (processor->active_thread && thread_eager_preemption(processor->active_thread))
-                       return (AST_PREEMPT | AST_URGENT);
-
-               return AST_PREEMPT;
+#endif
+       else if (do_cause_ast) {
+               cause_ast_check(processor);
        }
-
-       return AST_NONE;
-}
-
-static boolean_t
-processor_queue_has_priority(processor_t               processor,
-                                                        int                            priority,
-                                                        boolean_t                      gte)
-{
-       if (gte)
-               return runq_for_processor(processor)->highq >= priority;
-       else
-               return runq_for_processor(processor)->highq > priority;
-}
-
-static boolean_t
-should_current_thread_rechoose_processor(processor_t                   processor)
-{
-       return (processor->current_pri < BASEPRI_RTQUEUES
-                       && processor->processor_primary != processor);
-}
-
-static int
-sched_traditional_processor_runq_count(processor_t   processor)
-{
-       return runq_for_processor(processor)->count;
-}
-
-static uint64_t
-sched_traditional_processor_runq_stats_count_sum(processor_t   processor)
-{
-       return runq_for_processor(processor)->runq_stats.count_sum;
-}
-
-static uint64_t
-sched_traditional_with_pset_runqueue_processor_runq_stats_count_sum(processor_t   processor)
-{
-       if (processor->cpu_id == processor->processor_set->cpu_set_low)
-               return runq_for_processor(processor)->runq_stats.count_sum;
-       else
-               return 0ULL;
-}
-
-static int
-sched_traditional_processor_bound_count(processor_t   processor)
-{
-       return processor->runq_bound_count;
 }
 
-#endif /* CONFIG_SCHED_TRADITIONAL */
-
 /*
  *     choose_next_pset:
  *
@@ -3627,7 +3432,9 @@ choose_processor(
        thread_t                        thread)
 {
        processor_set_t         nset, cset = pset;
-       
+
+       assert(thread->sched_pri <= BASEPRI_RTQUEUES);
+
        /*
         * Prefer the hinted processor, when appropriate.
         */
@@ -3659,6 +3466,8 @@ choose_processor(
        if (processor != PROCESSOR_NULL) {
                if (processor->processor_set != pset) {
                        processor = PROCESSOR_NULL;
+               } else if (!processor->is_recommended) {
+                       processor = PROCESSOR_NULL;
                } else {
                        switch (processor->state) {
                                case PROCESSOR_START:
@@ -3676,7 +3485,6 @@ choose_processor(
                                         * the "least cost idle" processor above.
                                         */
                                        return (processor);
-                                       break;
                                case PROCESSOR_RUNNING:
                                case PROCESSOR_DISPATCHING:
                                        /*
@@ -3741,16 +3549,21 @@ choose_processor(
                /*
                 * Choose an idle processor, in pset traversal order
                 */
-               if (!queue_empty(&cset->idle_queue))
-                       return ((processor_t)queue_first(&cset->idle_queue));
+               qe_foreach_element(processor, &cset->idle_queue, processor_queue) {
+                       if (processor->is_recommended)
+                               return processor;
+               }
 
                /*
                 * Otherwise, enumerate active and idle processors to find candidates
                 * with lower priority/etc.
                 */
 
-               processor = (processor_t)queue_first(&cset->active_queue);
-               while (!queue_end(&cset->active_queue, (queue_entry_t)processor)) {
+               qe_foreach_element(processor, &cset->active_queue, processor_queue) {
+
+                       if (!processor->is_recommended) {
+                               continue;
+                       }
 
                        integer_t cpri = processor->current_pri;
                        if (cpri < lowest_priority) {
@@ -3768,16 +3581,18 @@ choose_processor(
                                lowest_count = ccount;
                                lc_processor = processor;
                        }
-
-                       processor = (processor_t)queue_next((queue_entry_t)processor);
                }
 
                /*
                 * For SMT configs, these idle secondary processors must have active primary. Otherwise
                 * the idle primary would have short-circuited the loop above
                 */
-               processor = (processor_t)queue_first(&cset->idle_secondary_queue);
-               while (!queue_end(&cset->idle_secondary_queue, (queue_entry_t)processor)) {
+               qe_foreach_element(processor, &cset->idle_secondary_queue, processor_queue) {
+
+                       if (!processor->is_recommended) {
+                               continue;
+                       }
+
                        processor_t cprimary = processor->processor_primary;
 
                        /* If the primary processor is offline or starting up, it's not a candidate for this path */
@@ -3790,8 +3605,6 @@ choose_processor(
                                        lp_unpaired_secondary_processor = processor;
                                }
                        }
-
-                       processor = (processor_t)queue_next((queue_entry_t)processor);
                }
 
 
@@ -3806,14 +3619,12 @@ choose_processor(
 
                        if (thread->sched_pri > lowest_unpaired_primary_priority) {
                                /* Move to end of active queue so that the next thread doesn't also pick it */
-                               remqueue((queue_entry_t)lp_unpaired_primary_processor);
-                               enqueue_tail(&cset->active_queue, (queue_entry_t)lp_unpaired_primary_processor);
+                               re_queue_tail(&cset->active_queue, &lp_unpaired_primary_processor->processor_queue);
                                return lp_unpaired_primary_processor;
                        }
                        if (thread->sched_pri > lowest_priority) {
                                /* Move to end of active queue so that the next thread doesn't also pick it */
-                               remqueue((queue_entry_t)lp_processor);
-                               enqueue_tail(&cset->active_queue, (queue_entry_t)lp_processor);
+                               re_queue_tail(&cset->active_queue, &lp_processor->processor_queue);
                                return lp_processor;
                        }
                        if (thread->realtime.deadline < furthest_deadline)
@@ -3829,14 +3640,12 @@ choose_processor(
 
                        if (thread->sched_pri > lowest_unpaired_primary_priority) {
                                /* Move to end of active queue so that the next thread doesn't also pick it */
-                               remqueue((queue_entry_t)lp_unpaired_primary_processor);
-                               enqueue_tail(&cset->active_queue, (queue_entry_t)lp_unpaired_primary_processor);
+                               re_queue_tail(&cset->active_queue, &lp_unpaired_primary_processor->processor_queue);
                                return lp_unpaired_primary_processor;
                        }
                        if (thread->sched_pri > lowest_priority) {
                                /* Move to end of active queue so that the next thread doesn't also pick it */
-                               remqueue((queue_entry_t)lp_processor);
-                               enqueue_tail(&cset->active_queue, (queue_entry_t)lp_processor);
+                               re_queue_tail(&cset->active_queue, &lp_processor->processor_queue);
                                return lp_processor;
                        }
 
@@ -3931,8 +3740,9 @@ thread_setrun(
        processor_t                     processor;
        processor_set_t         pset;
 
-       assert(thread_runnable(thread));
-       
+       assert((thread->state & (TH_RUN|TH_WAIT|TH_UNINT|TH_TERMINATE|TH_TERMINATE2)) == TH_RUN);
+       assert(thread->runq == PROCESSOR_NULL);
+
        /*
         *      Update priority if needed.
         */
@@ -3943,6 +3753,7 @@ thread_setrun(
 
        assert(thread->runq == PROCESSOR_NULL);
 
+#if __SMP__
        if (thread->bound_processor == PROCESSOR_NULL) {
                /*
                 *      Unbound case.
@@ -3956,11 +3767,9 @@ thread_setrun(
 
                        processor = SCHED(choose_processor)(pset, PROCESSOR_NULL, thread);
 
-                       KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_SCHED, MACH_SCHED_CHOOSE_PROCESSOR)|DBG_FUNC_NONE,
+                       SCHED_DEBUG_CHOOSE_PROCESSOR_KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_SCHED, MACH_SCHED_CHOOSE_PROCESSOR)|DBG_FUNC_NONE,
                                                                          (uintptr_t)thread_tid(thread), (uintptr_t)-1, processor->cpu_id, processor->state, 0);
-               }
-               else
-               if (thread->last_processor != PROCESSOR_NULL) {
+               } else if (thread->last_processor != PROCESSOR_NULL) {
                        /*
                         *      Simple (last processor) affinity case.
                         */
@@ -3969,10 +3778,9 @@ thread_setrun(
                        pset_lock(pset);
                        processor = SCHED(choose_processor)(pset, processor, thread);
 
-                       KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_SCHED, MACH_SCHED_CHOOSE_PROCESSOR)|DBG_FUNC_NONE,
+                       SCHED_DEBUG_CHOOSE_PROCESSOR_KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_SCHED, MACH_SCHED_CHOOSE_PROCESSOR)|DBG_FUNC_NONE,
                                                                  (uintptr_t)thread_tid(thread), thread->last_processor->cpu_id, processor->cpu_id, processor->state, 0);
-               }
-               else {
+               } else {
                        /*
                         *      No Affinity case:
                         *
@@ -3991,11 +3799,10 @@ thread_setrun(
                        processor = SCHED(choose_processor)(pset, PROCESSOR_NULL, thread);
                        task->pset_hint = processor->processor_set;
 
-                       KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_SCHED, MACH_SCHED_CHOOSE_PROCESSOR)|DBG_FUNC_NONE,
+                       SCHED_DEBUG_CHOOSE_PROCESSOR_KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_SCHED, MACH_SCHED_CHOOSE_PROCESSOR)|DBG_FUNC_NONE,
                                                                          (uintptr_t)thread_tid(thread), (uintptr_t)-1, processor->cpu_id, processor->state, 0);
                }
-       }
-       else {
+       } else {
                /*
                 *      Bound case:
                 *
@@ -4005,102 +3812,39 @@ thread_setrun(
                pset = processor->processor_set;
                pset_lock(pset);
 
-               KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_SCHED, MACH_SCHED_CHOOSE_PROCESSOR)|DBG_FUNC_NONE,
+               SCHED_DEBUG_CHOOSE_PROCESSOR_KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_SCHED, MACH_SCHED_CHOOSE_PROCESSOR)|DBG_FUNC_NONE,
                                                          (uintptr_t)thread_tid(thread), (uintptr_t)-2, processor->cpu_id, processor->state, 0);
        }
+#else /* !__SMP__ */
+       /* Only one processor to choose */
+       assert(thread->bound_processor == PROCESSOR_NULL || thread->bound_processor == master_processor);
+       processor = master_processor;
+       pset = processor->processor_set;
+       pset_lock(pset);
+#endif /* !__SMP__ */
 
        /*
-        *      Dispatch the thread on the choosen processor.
+        *      Dispatch the thread on the chosen processor.
         *      TODO: This should be based on sched_mode, not sched_pri
         */
        if (thread->sched_pri >= BASEPRI_RTQUEUES)
                realtime_setrun(processor, thread);
-       else if (thread->sched_mode == TH_MODE_FAIRSHARE)
-               fairshare_setrun(processor, thread);
        else
-               processor_setrun(processor, thread, options);
-}
-
-processor_set_t
-task_choose_pset(
-       task_t          task)
-{
-       processor_set_t         pset = task->pset_hint;
-
-       if (pset != PROCESSOR_SET_NULL)
-               pset = choose_next_pset(pset);
-
-       return (pset);
-}
-
-#if defined(CONFIG_SCHED_TRADITIONAL)
-
-/*
- *     processor_queue_shutdown:
- *
- *     Shutdown a processor run queue by
- *     re-dispatching non-bound threads.
- *
- *     Associated pset must be locked, and is
- *     returned unlocked.
- */
-void
-processor_queue_shutdown(
-       processor_t                     processor)
-{
-       processor_set_t         pset = processor->processor_set;
-       run_queue_t                     rq = runq_for_processor(processor);
-       queue_t                         queue = rq->queues + rq->highq;
-       int                                     pri = rq->highq, count = rq->count;
-       thread_t                        next, thread;
-       queue_head_t            tqueue;
-
-       queue_init(&tqueue);
-       
-       while (count > 0) {
-               thread = (thread_t)queue_first(queue);
-               while (!queue_end(queue, (queue_entry_t)thread)) {
-                       next = (thread_t)queue_next((queue_entry_t)thread);
-
-                       if (thread->bound_processor == PROCESSOR_NULL) {
-                               remqueue((queue_entry_t)thread);
-
-                               thread->runq = PROCESSOR_NULL;
-                               SCHED_STATS_RUNQ_CHANGE(&rq->runq_stats, rq->count);
-                               runq_consider_decr_bound_count(processor, thread);
-                               rq->count--;
-                               if (SCHED(priority_is_urgent)(pri)) {
-                                       rq->urgency--; assert(rq->urgency >= 0);
-                               }
-                               if (queue_empty(queue)) {
-                                       if (pri != IDLEPRI)
-                                               clrbit(MAXPRI - pri, rq->bitmap);
-                                       rq->highq = MAXPRI - ffsbit(rq->bitmap);
-                               }
-
-                               enqueue_tail(&tqueue, (queue_entry_t)thread);
-                       }
-                       count--;
-
-                       thread = next;
-               }
-
-               queue--; pri--;
-       }
-
-       pset_unlock(pset);
+               processor_setrun(processor, thread, options);
+}
 
-       while ((thread = (thread_t)dequeue_head(&tqueue)) != THREAD_NULL) {
-               thread_lock(thread);
+processor_set_t
+task_choose_pset(
+       task_t          task)
+{
+       processor_set_t         pset = task->pset_hint;
 
-               thread_setrun(thread, SCHED_TAILQ);
+       if (pset != PROCESSOR_SET_NULL)
+               pset = choose_next_pset(pset);
 
-               thread_unlock(thread);
-       }
+       return (pset);
 }
 
-#endif /* CONFIG_SCHED_TRADITIONAL */
-
 /*
  *     Check for a preemption point in
  *     the current context.
@@ -4118,7 +3862,7 @@ csw_check(
        pset_lock(pset);
 
        /* If we were sent a remote AST and interrupted a running processor, acknowledge it here with pset lock held */
-       pset->pending_AST_cpu_mask &= ~(1U << processor->cpu_id);
+       pset->pending_AST_cpu_mask &= ~(1ULL << processor->cpu_id);
 
        result = csw_check_locked(processor, pset, check_reason);
 
@@ -4140,7 +3884,7 @@ csw_check_locked(
        ast_t                   result;
        thread_t                thread = processor->active_thread;
 
-       if (first_timeslice(processor)) {
+       if (processor->first_timeslice) {
                if (rt_runq.count > 0)
                        return (check_reason | AST_PREEMPT | AST_URGENT);
        }
@@ -4155,14 +3899,41 @@ csw_check_locked(
 
        result = SCHED(processor_csw_check)(processor);
        if (result != AST_NONE)
-               return (check_reason | result);
+               return (check_reason | result | (thread_eager_preemption(thread) ? AST_URGENT : AST_NONE));
+
+#if __SMP__
 
-       if (SCHED(should_current_thread_rechoose_processor)(processor))
+       /*
+        * If the current thread is running on a processor that is no longer recommended, gently
+        * (non-urgently) get to a point and then block, and which point thread_select() should
+        * try to idle the processor and re-dispatch the thread to a recommended processor.
+        */
+       if (!processor->is_recommended)
                return (check_reason | AST_PREEMPT);
-       
+
+       /*
+        * Even though we could continue executing on this processor, a
+        * secondary SMT core should try to shed load to another primary core.
+        *
+        * TODO: Should this do the same check that thread_select does? i.e.
+        * if no bound threads target this processor, and idle primaries exist, preempt
+        * The case of RT threads existing is already taken care of above
+        * Consider Capri in this scenario.
+        *
+        * if (!SCHED(processor_bound_count)(processor) && !queue_empty(&pset->idle_queue))
+        *
+        * TODO: Alternatively - check if only primary is idle, or check if primary's pri is lower than mine.
+        */
+
+       if (processor->current_pri < BASEPRI_RTQUEUES &&
+           processor->processor_primary != processor)
+               return (check_reason | AST_PREEMPT);
+#endif
+
        if (thread->state & TH_SUSP)
                return (check_reason | AST_PREEMPT);
 
+#if CONFIG_SCHED_SFI
        /*
         * Current thread may not need to be preempted, but maybe needs
         * an SFI wait?
@@ -4170,6 +3941,7 @@ csw_check_locked(
        result = sfi_thread_needs_ast(thread, NULL);
        if (result != AST_NONE)
                return (check_reason | result);
+#endif
 
        return (AST_NONE);
 }
@@ -4185,128 +3957,108 @@ csw_check_locked(
  */
 void
 set_sched_pri(
-       thread_t                thread,
-       int                     priority)
+              thread_t        thread,
+              int             priority)
 {
-       boolean_t               removed = thread_run_queue_remove(thread);
+       thread_t cthread = current_thread();
+       boolean_t is_current_thread = (thread == cthread) ? TRUE : FALSE;
        int curgency, nurgency;
        uint64_t urgency_param1, urgency_param2;
-       thread_t cthread = current_thread();
+       boolean_t removed_from_runq = FALSE;
+
+       /* If we're already at this priority, no need to mess with the runqueue */
+       if (priority == thread->sched_pri)
+               return;
 
-       if (thread == cthread) {
+       if (is_current_thread) {
+               assert(thread->runq == PROCESSOR_NULL);
                curgency = thread_get_urgency(thread, &urgency_param1, &urgency_param2);
+       } else {
+               removed_from_runq = thread_run_queue_remove(thread);
        }
-       
+
        thread->sched_pri = priority;
 
-       if (thread == cthread) {
+       KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_SCHED, MACH_SCHED_CHANGE_PRIORITY),
+                             (uintptr_t)thread_tid(thread),
+                             thread->base_pri,
+                             thread->sched_pri,
+                             0, /* eventually, 'reason' */
+                             0);
+
+       if (is_current_thread) {
                nurgency = thread_get_urgency(thread, &urgency_param1, &urgency_param2);
-/* set_sched_pri doesn't alter RT params. We expect direct base priority/QoS
- * class alterations from user space to occur relatively infrequently, hence
- * those are lazily handled. QoS classes have distinct priority bands, and QoS
- * inheritance is expected to involve priority changes.
- */
+               /*
+                * set_sched_pri doesn't alter RT params. We expect direct base priority/QoS
+                * class alterations from user space to occur relatively infrequently, hence
+                * those are lazily handled. QoS classes have distinct priority bands, and QoS
+                * inheritance is expected to involve priority changes.
+                */
                if (nurgency != curgency) {
-                       thread_tell_urgency(nurgency, urgency_param1, urgency_param2, thread);
+                       thread_tell_urgency(nurgency, urgency_param1, urgency_param2, 0, thread);
+                       machine_thread_going_on_core(thread, nurgency, 0);
                }
        }
 
-       if (removed)
-               thread_setrun(thread, SCHED_PREEMPT | SCHED_TAILQ);
-       else
-       if (thread->state & TH_RUN) {
-               processor_t             processor = thread->last_processor;
+       /* TODO: Should this be TAILQ if it went down, HEADQ if it went up? */
+       if (removed_from_runq)
+               thread_run_queue_reinsert(thread, SCHED_PREEMPT | SCHED_TAILQ);
+       else if (thread->state & TH_RUN) {
+               processor_t processor = thread->last_processor;
 
-               if (thread == current_thread()) {
-                       ast_t                   preempt;
+               if (is_current_thread) {
+                       ast_t preempt;
 
                        processor->current_pri = priority;
                        processor->current_thmode = thread->sched_mode;
                        processor->current_sfi_class = thread->sfi_class = sfi_thread_classify(thread);
                        if ((preempt = csw_check(processor, AST_NONE)) != AST_NONE)
                                ast_on(preempt);
-               }
-               else
-               if (    processor != PROCESSOR_NULL                                             &&
-                               processor->active_thread == thread      )
+               } else if (processor != PROCESSOR_NULL && processor->active_thread == thread)
                        cause_ast_check(processor);
        }
 }
 
-#if            0
+/*
+ * thread_run_queue_remove_for_handoff
+ *
+ * Pull a thread or its (recursive) push target out of the runqueue
+ * so that it is ready for thread_run()
+ *
+ * Called at splsched
+ *
+ * Returns the thread that was pulled or THREAD_NULL if no thread could be pulled.
+ * This may be different than the thread that was passed in.
+ */
+thread_t
+thread_run_queue_remove_for_handoff(thread_t thread) {
 
-static void
-run_queue_check(
-       run_queue_t             rq,
-       thread_t                thread)
-{
-       queue_t                 q;
-       queue_entry_t   qe;
+       thread_t pulled_thread = THREAD_NULL;
 
-       if (rq != thread->runq)
-               panic("run_queue_check: thread runq");
+       thread_lock(thread);
 
-       if (thread->sched_pri > MAXPRI || thread->sched_pri < MINPRI)
-               panic("run_queue_check: thread sched_pri");
+       /*
+        * Check that the thread is not bound
+        * to a different processor, and that realtime
+        * is not involved.
+        *
+        * Next, pull it off its run queue.  If it
+        * doesn't come, it's not eligible.
+        */
 
-       q = &rq->queues[thread->sched_pri];
-       qe = queue_first(q);
-       while (!queue_end(q, qe)) {
-               if (qe == (queue_entry_t)thread)
-                       return;
+       processor_t processor = current_processor();
+       if (processor->current_pri < BASEPRI_RTQUEUES && thread->sched_pri < BASEPRI_RTQUEUES &&
+           (thread->bound_processor == PROCESSOR_NULL || thread->bound_processor == processor)) {
 
-               qe = queue_next(qe);
+                       if (thread_run_queue_remove(thread))
+                               pulled_thread = thread;
        }
 
-       panic("run_queue_check: end");
-}
-
-#endif /* DEBUG */
-
-#if defined(CONFIG_SCHED_TRADITIONAL)
-
-/*
- * Locks the runqueue itself.
- *
- * Thread must be locked.
- */
-static boolean_t
-processor_queue_remove(
-                                          processor_t                  processor,
-                                          thread_t             thread)
-{
-       void *                  rqlock;
-       run_queue_t             rq;
-       
-       rqlock = &processor->processor_set->sched_lock;
-       rq = runq_for_processor(processor);
-
-       simple_lock(rqlock);
-       if (processor == thread->runq) {
-               /*
-                *      Thread is on a run queue and we have a lock on
-                *      that run queue.
-                */
-               runq_consider_decr_bound_count(processor, thread);
-               run_queue_remove(rq, thread);
-       }
-       else {
-               /*
-                *      The thread left the run queue before we could
-                *      lock the run queue.
-                */
-               assert(thread->runq == PROCESSOR_NULL);
-               processor = PROCESSOR_NULL;
-       }
-       
-       simple_unlock(rqlock);
+       thread_unlock(thread);
 
-       return (processor != PROCESSOR_NULL);
+       return pulled_thread;
 }
 
-#endif /* CONFIG_SCHED_TRADITIONAL */
-
-
 /*
  *     thread_run_queue_remove:
  *
@@ -4352,25 +4104,21 @@ thread_run_queue_remove(
                return FALSE;
        }
 
-       if (thread->sched_mode == TH_MODE_FAIRSHARE) {
-               return SCHED(fairshare_queue_remove)(thread);
-       }
-       
        if (thread->sched_pri < BASEPRI_RTQUEUES) {
                return SCHED(processor_queue_remove)(processor, thread);
        }
 
-       simple_lock(&rt_lock);
+       rt_lock_lock();
 
        if (thread->runq != PROCESSOR_NULL) {
                /*
-                *      Thread is on a run queue and we have a lock on
+                *      Thread is on the RT run queue and we have a lock on
                 *      that run queue.
                 */
 
-               assert(thread->runq == RT_RUNQ);
+               assert(thread->runq == THREAD_ON_RT_RUNQ);
 
-               remqueue((queue_entry_t)thread);
+               remqueue(&thread->runq_links);
                SCHED_STATS_RUNQ_CHANGE(&rt_runq.runq_stats, rt_runq.count);
                rt_runq.count--;
 
@@ -4379,125 +4127,28 @@ thread_run_queue_remove(
                removed = TRUE;
        }
 
-       simple_unlock(&rt_lock);
+       rt_lock_unlock();
 
        return (removed);
 }
 
-#if defined(CONFIG_SCHED_TRADITIONAL)
-
-/*
- *     steal_processor_thread:
- *
- *     Locate a thread to steal from the processor and
- *     return it.
- *
- *     Associated pset must be locked.  Returns THREAD_NULL
- *     on failure.
- */
-static thread_t
-steal_processor_thread(
-       processor_t             processor)
-{
-       run_queue_t             rq = runq_for_processor(processor);
-       queue_t                 queue = rq->queues + rq->highq;
-       int                             pri = rq->highq, count = rq->count;
-       thread_t                thread;
-
-       while (count > 0) {
-               thread = (thread_t)queue_first(queue);
-               while (!queue_end(queue, (queue_entry_t)thread)) {
-                       if (thread->bound_processor == PROCESSOR_NULL) {
-                               remqueue((queue_entry_t)thread);
-
-                               thread->runq = PROCESSOR_NULL;
-                               SCHED_STATS_RUNQ_CHANGE(&rq->runq_stats, rq->count);
-                               runq_consider_decr_bound_count(processor, thread);
-                               rq->count--;
-                               if (SCHED(priority_is_urgent)(pri)) {
-                                       rq->urgency--; assert(rq->urgency >= 0);
-                               }
-                               if (queue_empty(queue)) {
-                                       if (pri != IDLEPRI)
-                                               clrbit(MAXPRI - pri, rq->bitmap);
-                                       rq->highq = MAXPRI - ffsbit(rq->bitmap);
-                               }
-
-                               return (thread);
-                       }
-                       count--;
-
-                       thread = (thread_t)queue_next((queue_entry_t)thread);
-               }
-
-               queue--; pri--;
-       }
-
-       return (THREAD_NULL);
-}
-
 /*
- *     Locate and steal a thread, beginning
- *     at the pset.
+ * Put the thread back where it goes after a thread_run_queue_remove
  *
- *     The pset must be locked, and is returned
- *     unlocked.
+ * Thread must have been removed under the same thread lock hold
  *
- *     Returns the stolen thread, or THREAD_NULL on
- *     failure.
+ * thread locked, at splsched
  */
-static thread_t
-steal_thread(
-       processor_set_t         pset)
+void
+thread_run_queue_reinsert(thread_t thread, integer_t options)
 {
-       processor_set_t         nset, cset = pset;
-       processor_t                     processor;
-       thread_t                        thread;
-
-       do {
-               processor = (processor_t)queue_first(&cset->active_queue);
-               while (!queue_end(&cset->active_queue, (queue_entry_t)processor)) {
-                       if (runq_for_processor(processor)->count > 0) {
-                               thread = steal_processor_thread(processor);
-                               if (thread != THREAD_NULL) {
-                                       remqueue((queue_entry_t)processor);
-                                       enqueue_tail(&cset->active_queue, (queue_entry_t)processor);
-
-                                       pset_unlock(cset);
-
-                                       return (thread);
-                               }
-                       }
-
-                       processor = (processor_t)queue_next((queue_entry_t)processor);
-               }
-
-               nset = next_pset(cset);
-
-               if (nset != pset) {
-                       pset_unlock(cset);
-
-                       cset = nset;
-                       pset_lock(cset);
-               }
-       } while (nset != pset);
-
-       pset_unlock(cset);
-
-       return (THREAD_NULL);
-}
+       assert(thread->runq == PROCESSOR_NULL);
 
-static thread_t        steal_thread_disabled(
-                                       processor_set_t         pset)
-{
-       pset_unlock(pset);
+               assert(thread->state & (TH_RUN));
+               thread_setrun(thread, options);
 
-       return (THREAD_NULL);
 }
 
-#endif /* CONFIG_SCHED_TRADITIONAL */
-
-
 void
 sys_override_cpu_throttle(int flag)
 {
@@ -4521,22 +4172,21 @@ thread_get_urgency(thread_t thread, uint64_t *arg1, uint64_t *arg2)
 
                return (THREAD_URGENCY_REAL_TIME);
        } else if (cpu_throttle_enabled &&
-                  ((thread->sched_pri <= MAXPRI_THROTTLE) && (thread->priority <= MAXPRI_THROTTLE)))  {
+                  ((thread->sched_pri <= MAXPRI_THROTTLE) && (thread->base_pri <= MAXPRI_THROTTLE)))  {
                /*
                 * Background urgency applied when thread priority is MAXPRI_THROTTLE or lower and thread is not promoted
-                * TODO: Use TH_SFLAG_THROTTLED instead?
                 */
                *arg1 = thread->sched_pri;
-               *arg2 = thread->priority;
+               *arg2 = thread->base_pri;
 
                return (THREAD_URGENCY_BACKGROUND);
        } else {
                /* For otherwise unclassified threads, report throughput QoS
                 * parameters
                 */
-               *arg1 = thread->effective_policy.t_through_qos;
-               *arg2 = thread->task->effective_policy.t_through_qos;
-               
+               *arg1 = proc_get_effective_thread_policy(thread, TASK_POLICY_THROUGH_QOS);
+               *arg2 = proc_get_effective_task_policy(thread->task, TASK_POLICY_THROUGH_QOS);
+
                return (THREAD_URGENCY_NORMAL);
        }
 }
@@ -4579,10 +4229,16 @@ processor_idle(
        while (1) {
                if (processor->state != PROCESSOR_IDLE) /* unsafe, but worst case we loop around once */
                        break;
-               if (pset->pending_AST_cpu_mask & (1U << processor->cpu_id))
-                       break;
-               if (rt_runq.count)
+               if (pset->pending_AST_cpu_mask & (1ULL << processor->cpu_id))
                        break;
+               if (processor->is_recommended) {
+                       if (rt_runq.count)
+                               break;
+               } else {
+                       if (SCHED(processor_bound_count)(processor))
+                               break;
+               }
+
 #if CONFIG_SCHED_IDLE_IN_PLACE
                if (thread != THREAD_NULL) {
                        /* Did idle-in-place thread wake up */
@@ -4621,7 +4277,10 @@ processor_idle(
        pset_lock(pset);
 
        /* If we were sent a remote AST and came out of idle, acknowledge it here with pset lock held */
-       pset->pending_AST_cpu_mask &= ~(1U << processor->cpu_id);
+       pset->pending_AST_cpu_mask &= ~(1ULL << processor->cpu_id);
+#if defined(CONFIG_SCHED_DEFERRED_AST)
+       pset->pending_deferred_AST_cpu_mask &= ~(1ULL << processor->cpu_id);
+#endif
 
        state = processor->state;
        if (state == PROCESSOR_DISPATCHING) {
@@ -4633,7 +4292,7 @@ processor_idle(
                processor->state = PROCESSOR_RUNNING;
 
                if ((new_thread != THREAD_NULL) && (SCHED(processor_queue_has_priority)(processor, new_thread->sched_pri, FALSE)                                        ||
-                                                                                       (rt_runq.count > 0 && BASEPRI_RTQUEUES >= new_thread->sched_pri))       ) {
+                                                                                       (rt_runq.count > 0))    ) {
                        /* Something higher priority has popped up on the runqueue - redispatch this thread elsewhere */
                        processor->current_pri = IDLEPRI;
                        processor->current_thmode = TH_MODE_FIXED;
@@ -4659,22 +4318,19 @@ processor_idle(
                KERNEL_DEBUG_CONSTANT_IST(KDEBUG_TRACE,
                        MACHDBG_CODE(DBG_MACH_SCHED,MACH_IDLE) | DBG_FUNC_END, 
                        (uintptr_t)thread_tid(thread), state, (uintptr_t)thread_tid(new_thread), 0, 0);
-                       
+
                return (new_thread);
-       }
-       else
-       if (state == PROCESSOR_IDLE) {
-               remqueue((queue_entry_t)processor);
+
+       } else if (state == PROCESSOR_IDLE) {
+               re_queue_tail(&pset->active_queue, &processor->processor_queue);
 
                processor->state = PROCESSOR_RUNNING;
                processor->current_pri = IDLEPRI;
                processor->current_thmode = TH_MODE_FIXED;
                processor->current_sfi_class = SFI_CLASS_KERNEL;
                processor->deadline = UINT64_MAX;
-               enqueue_tail(&pset->active_queue, (queue_entry_t)processor);
-       }
-       else
-       if (state == PROCESSOR_SHUTDOWN) {
+
+       } else if (state == PROCESSOR_SHUTDOWN) {
                /*
                 *      Going off-line.  Force a
                 *      reschedule.
@@ -4746,7 +4402,7 @@ idle_thread_create(
        thread_lock(thread);
        thread->bound_processor = processor;
        processor->idle_thread = thread;
-       thread->sched_pri = thread->priority = IDLEPRI;
+       thread->sched_pri = thread->base_pri = IDLEPRI;
        thread->state = (TH_RUN | TH_IDLE);
        thread->options |= TH_OPT_IDLE_THREAD;
        thread_unlock(thread);
@@ -4770,6 +4426,9 @@ sched_startup(void)
        kern_return_t   result;
        thread_t                thread;
 
+       simple_lock_init(&sched_vm_group_list_lock, 0);
+
+
        result = kernel_thread_start_priority((thread_continue_t)sched_init_thread,
            (void *)SCHED(maintenance_continuation), MAXPRI_KERNEL, &thread);
        if (result != KERN_SUCCESS)
@@ -4777,6 +4436,8 @@ sched_startup(void)
 
        thread_deallocate(thread);
 
+       assert_thread_magic(thread);
+
        /*
         * Yield to the sched_init_thread once, to
         * initialize our own thread after being switched
@@ -4791,9 +4452,6 @@ sched_startup(void)
 #if defined(CONFIG_SCHED_TIMESHARE_CORE)
 
 static volatile uint64_t               sched_maintenance_deadline;
-#if defined(CONFIG_TELEMETRY)
-static volatile uint64_t               sched_telemetry_deadline = 0;
-#endif
 static uint64_t                                sched_tick_last_abstime;
 static uint64_t                                sched_tick_delta;
 uint64_t                               sched_tick_max_delta;
@@ -4804,10 +4462,16 @@ uint64_t                                sched_tick_max_delta;
  *     times per second.
  */
 void
-sched_traditional_maintenance_continue(void)
+sched_timeshare_maintenance_continue(void)
 {
        uint64_t        sched_tick_ctime, late_time;
 
+       struct sched_update_scan_context scan_context = {
+               .earliest_bg_make_runnable_time = UINT64_MAX,
+               .earliest_normal_make_runnable_time = UINT64_MAX,
+               .earliest_rt_make_runnable_time = UINT64_MAX
+       };
+
        sched_tick_ctime = mach_absolute_time();        
 
        if (__improbable(sched_tick_last_abstime == 0)) {
@@ -4836,17 +4500,13 @@ sched_traditional_maintenance_continue(void)
        }
 
        KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_SCHED, MACH_SCHED_MAINTENANCE)|DBG_FUNC_START,
-                                                 sched_tick_delta,
-                                                 late_time,
-                                                 0,
-                                                 0,
-                                                 0);
+               sched_tick_delta, late_time, 0, 0, 0);
 
        /* Add a number of pseudo-ticks corresponding to the elapsed interval
         * This could be greater than 1 if substantial intervals where
         * all processors are idle occur, which rarely occurs in practice.
         */
-       
+
        sched_tick += sched_tick_delta;
 
        /*
@@ -4856,19 +4516,38 @@ sched_traditional_maintenance_continue(void)
 
        /*
         *  Scan the run queues for threads which
-        *  may need to be updated.
+        *  may need to be updated, and find the earliest runnable thread on the runqueue
+        *  to report its latency.
+        */
+       SCHED(thread_update_scan)(&scan_context);
+
+       rt_runq_scan(&scan_context);
+
+       uint64_t ctime = mach_absolute_time();
+
+       uint64_t bg_max_latency       = (ctime > scan_context.earliest_bg_make_runnable_time) ?
+                                        ctime - scan_context.earliest_bg_make_runnable_time : 0;
+
+       uint64_t default_max_latency  = (ctime > scan_context.earliest_normal_make_runnable_time) ?
+                                        ctime - scan_context.earliest_normal_make_runnable_time : 0;
+
+       uint64_t realtime_max_latency = (ctime > scan_context.earliest_rt_make_runnable_time) ?
+                                        ctime - scan_context.earliest_rt_make_runnable_time : 0;
+
+       machine_max_runnable_latency(bg_max_latency, default_max_latency, realtime_max_latency);
+
+       /*
+        * Check to see if the special sched VM group needs attention.
         */
-       SCHED(thread_update_scan)();
+       sched_vm_group_maintenance();
 
-       KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_SCHED, MACH_SCHED_MAINTENANCE)|DBG_FUNC_END,
-                                                 sched_pri_shift,
-                                                 sched_background_pri_shift,
-                                                 0,
-                                                 0,
-                                                 0);
 
-       assert_wait((event_t)sched_traditional_maintenance_continue, THREAD_UNINT);
-       thread_block((thread_continue_t)sched_traditional_maintenance_continue);
+       KERNEL_DEBUG_CONSTANT(MACHDBG_CODE(DBG_MACH_SCHED, MACH_SCHED_MAINTENANCE) | DBG_FUNC_END,
+               sched_pri_shifts[TH_BUCKET_SHARE_FG], sched_pri_shifts[TH_BUCKET_SHARE_BG],
+               sched_pri_shifts[TH_BUCKET_SHARE_UT], 0, 0);
+
+       assert_wait((event_t)sched_timeshare_maintenance_continue, THREAD_UNINT);
+       thread_block((thread_continue_t)sched_timeshare_maintenance_continue);
        /*NOTREACHED*/
 }
 
@@ -4885,7 +4564,7 @@ static uint64_t sched_maintenance_wakeups;
  * no more than a comparison against the deadline in the common case.
  */
 void
-sched_traditional_consider_maintenance(uint64_t ctime) {
+sched_timeshare_consider_maintenance(uint64_t ctime) {
        uint64_t ndeadline, deadline = sched_maintenance_deadline;
 
        if (__improbable(ctime >= deadline)) {
@@ -4896,30 +4575,10 @@ sched_traditional_consider_maintenance(uint64_t ctime) {
                ndeadline = ctime + sched_tick_interval;
 
                if (__probable(__sync_bool_compare_and_swap(&sched_maintenance_deadline, deadline, ndeadline))) {
-                       thread_wakeup((event_t)sched_traditional_maintenance_continue);
+                       thread_wakeup((event_t)sched_timeshare_maintenance_continue);
                        sched_maintenance_wakeups++;
                }
        }
-
-#if defined(CONFIG_TELEMETRY)
-       /*
-        * Windowed telemetry is driven by the scheduler.  It should be safe
-        * to call compute_telemetry_windowed() even when windowed telemetry
-        * is disabled, but we should try to avoid doing extra work for no
-        * reason.
-        */
-       if (telemetry_window_enabled) {
-               deadline = sched_telemetry_deadline;
-
-               if (__improbable(ctime >= deadline)) {
-                       ndeadline = ctime + sched_telemetry_interval;
-
-                       if (__probable(__sync_bool_compare_and_swap(&sched_telemetry_deadline, deadline, ndeadline))) {
-                               compute_telemetry_windowed();
-                       }
-               }
-       }
-#endif /* CONFIG_TELEMETRY */
 }
 
 #endif /* CONFIG_SCHED_TIMESHARE_CORE */
@@ -4929,7 +4588,12 @@ sched_init_thread(void (*continuation)(void))
 {
        thread_block(THREAD_CONTINUE_NULL);
 
-       sched_maintenance_thread = current_thread();
+       thread_t thread = current_thread();
+
+       thread_set_thread_name(thread, "sched_maintenance_thread");
+
+       sched_maintenance_thread = thread;
+
        continuation();
 
        /*NOTREACHED*/
@@ -4955,8 +4619,8 @@ sched_init_thread(void (*continuation)(void))
 
 #define        THREAD_UPDATE_SIZE              128
 
-static thread_t                thread_update_array[THREAD_UPDATE_SIZE];
-static int                     thread_update_count = 0;
+static thread_t thread_update_array[THREAD_UPDATE_SIZE];
+static uint32_t thread_update_count = 0;
 
 /* Returns TRUE if thread was added, FALSE if thread_update_array is full */
 boolean_t
@@ -4973,14 +4637,16 @@ thread_update_add_thread(thread_t thread)
 void
 thread_update_process_threads(void)
 {
-       while (thread_update_count > 0) {
-               spl_t   s;
-               thread_t thread = thread_update_array[--thread_update_count];
-               thread_update_array[thread_update_count] = THREAD_NULL;
+       assert(thread_update_count <= THREAD_UPDATE_SIZE);
 
-               s = splsched();
+       for (uint32_t i = 0 ; i < thread_update_count ; i++) {
+               thread_t thread = thread_update_array[i];
+               assert_thread_magic(thread);
+               thread_update_array[i] = THREAD_NULL;
+
+               spl_t s = splsched();
                thread_lock(thread);
-               if (!(thread->state & (TH_WAIT)) && (SCHED(can_update_priority)(thread))) {
+               if (!(thread->state & (TH_WAIT)) && thread->sched_stamp != sched_tick) {
                        SCHED(update_priority)(thread);
                }
                thread_unlock(thread);
@@ -4988,6 +4654,8 @@ thread_update_process_threads(void)
 
                thread_deallocate(thread);
        }
+
+       thread_update_count = 0;
 }
 
 /*
@@ -4997,79 +4665,51 @@ thread_update_process_threads(void)
  */
 boolean_t
 runq_scan(
-       run_queue_t                             runq)
+          run_queue_t                   runq,
+          sched_update_scan_context_t   scan_context)
 {
-       register int                    count;
-       register queue_t                q;
-       register thread_t               thread;
-
-       if ((count = runq->count) > 0) {
-           q = runq->queues + runq->highq;
-               while (count > 0) {
-                       queue_iterate(q, thread, thread_t, links) {
-                               if (            thread->sched_stamp != sched_tick               &&
-                                               (thread->sched_mode == TH_MODE_TIMESHARE)       ) {
-                                       if (thread_update_add_thread(thread) == FALSE)
-                                               return (TRUE);
-                               }
-
-                               count--;
-                       }
-
-                       q--;
-               }
-       }
+       int count       = runq->count;
+       int queue_index;
 
-       return (FALSE);
-}
-
-#endif /* CONFIG_SCHED_TIMESHARE_CORE */
-
-#if defined(CONFIG_SCHED_TRADITIONAL)
-
-static void
-thread_update_scan(void)
-{
-       boolean_t                       restart_needed = FALSE;
-       processor_t                     processor = processor_list;
-       processor_set_t         pset;
-       thread_t                        thread;
-       spl_t                           s;
+       assert(count >= 0);
 
-       do {
-               do {
-                       /*
-                        * TODO: in sched_traditional_use_pset_runqueue case,
-                        *  avoid scanning the same runq multiple times
-                        */
-                       pset = processor->processor_set;
+       if (count == 0)
+               return FALSE;
 
-                       s = splsched();
-                       pset_lock(pset);
+       for (queue_index = bitmap_first(runq->bitmap, NRQS);
+            queue_index >= 0;
+            queue_index = bitmap_next(runq->bitmap, queue_index)) {
 
-                       restart_needed = runq_scan(runq_for_processor(processor));
+               thread_t thread;
+               queue_t  queue = &runq->queues[queue_index];
 
-                       pset_unlock(pset);
-                       splx(s);
+               qe_foreach_element(thread, queue, runq_links) {
+                       assert(count > 0);
+                       assert_thread_magic(thread);
 
-                       if (restart_needed)
-                               break;
+                       if (thread->sched_stamp != sched_tick &&
+                           thread->sched_mode == TH_MODE_TIMESHARE) {
+                               if (thread_update_add_thread(thread) == FALSE)
+                                       return TRUE;
+                       }
 
-                       thread = processor->idle_thread;
-                       if (thread != THREAD_NULL && thread->sched_stamp != sched_tick) {
-                               if (thread_update_add_thread(thread) == FALSE) {
-                                       restart_needed = TRUE;
-                                       break;
+                       if (cpu_throttle_enabled && ((thread->sched_pri <= MAXPRI_THROTTLE) && (thread->base_pri <= MAXPRI_THROTTLE))) {
+                               if (thread->last_made_runnable_time < scan_context->earliest_bg_make_runnable_time) {
+                                       scan_context->earliest_bg_make_runnable_time = thread->last_made_runnable_time;
+                               }
+                       } else {
+                               if (thread->last_made_runnable_time < scan_context->earliest_normal_make_runnable_time) {
+                                       scan_context->earliest_normal_make_runnable_time = thread->last_made_runnable_time;
                                }
                        }
-               } while ((processor = processor->processor_list) != NULL);
+                       count--;
+               }
+       }
 
-               /* Ok, we now have a collection of candidates -- fix them. */
-               thread_update_process_threads();
-       } while (restart_needed);
+       return FALSE;
 }
 
-#endif /* CONFIG_SCHED_TRADITIONAL */
+#endif /* CONFIG_SCHED_TIMESHARE_CORE */
 
 boolean_t
 thread_eager_preemption(thread_t thread) 
@@ -5124,6 +4764,7 @@ thread_clear_eager_preempt(thread_t thread)
        thread_unlock(thread);
        splx(x);
 }
+
 /*
  * Scheduling statistics
  */
@@ -5185,15 +4826,52 @@ preemption_enabled(void)
        return (get_preemption_level() == 0 && ml_get_interrupts_enabled());
 }
 
-__assert_only static boolean_t
-thread_runnable(
-       thread_t        thread)
-{
-       return ((thread->state & (TH_RUN|TH_WAIT)) == TH_RUN);
-}
-
 static void
 sched_timer_deadline_tracking_init(void) {
        nanoseconds_to_absolutetime(TIMER_DEADLINE_TRACKING_BIN_1_DEFAULT, &timer_deadline_tracking_bin_1);
        nanoseconds_to_absolutetime(TIMER_DEADLINE_TRACKING_BIN_2_DEFAULT, &timer_deadline_tracking_bin_2);
 }
+
+
+kern_return_t
+sched_work_interval_notify(thread_t thread, uint64_t work_interval_id, uint64_t start, uint64_t finish, uint64_t deadline, uint64_t next_start, uint32_t flags)
+{
+       int urgency;
+       uint64_t urgency_param1, urgency_param2;
+       spl_t s;
+
+       if (work_interval_id == 0) {
+               return (KERN_INVALID_ARGUMENT);
+       }
+
+       assert(thread == current_thread());
+
+       thread_mtx_lock(thread);
+       if (thread->work_interval_id != work_interval_id) {
+               thread_mtx_unlock(thread);
+               return (KERN_INVALID_ARGUMENT);
+       }
+       thread_mtx_unlock(thread);
+
+       s = splsched();
+       thread_lock(thread);
+       urgency = thread_get_urgency(thread, &urgency_param1, &urgency_param2);
+       thread_unlock(thread);
+       splx(s);
+
+       machine_work_interval_notify(thread, work_interval_id, start, finish, deadline, next_start, urgency, flags);
+       return (KERN_SUCCESS);
+}
+
+void thread_set_options(uint32_t thopt) {
+       spl_t x;
+       thread_t t = current_thread();
+       x = splsched();
+       thread_lock(t);
+       t->options |= thopt;
+       thread_unlock(t);
+       splx(x);
+}