From: Dario Faggioli <raist...@linux.it>

Introduces the data structures, constants and symbols needed for
SCHED_DEADLINE implementation.

Core data structure of SCHED_DEADLINE are defined, along with their
initializers. Hooks for checking if a task belong to the new policy
are also added where they are needed.

Adds a scheduling class, in sched/dl.c and a new policy called
SCHED_DEADLINE. It is an implementation of the Earliest Deadline
First (EDF) scheduling algorithm, augmented with a mechanism (called
Constant Bandwidth Server, CBS) that makes it possible to isolate
the behaviour of tasks between each other.

The typical -deadline task will be made up of a computation phase
(instance) which is activated on a periodic or sporadic fashion. The
expected (maximum) duration of such computation is called the task's
runtime; the time interval by which each instance need to be completed
is called the task's relative deadline. The task's absolute deadline
is dynamically calculated as the time instant a task (better, an
instance) activates plus the relative deadline.

The EDF algorithms selects the task with the smallest absolute
deadline as the one to be executed first, while the CBS ensures each
task to run for at most its runtime every (relative) deadline
length time interval, avoiding any interference between different
tasks (bandwidth isolation).
Thanks to this feature, also tasks that do not strictly comply with
the computational model sketched above can effectively use the new
policy.

To summarize, this patch:
 - introduces the data structures, constants and symbols needed;
 - implements the core logic of the scheduling algorithm in the new
   scheduling class file;
 - provides all the glue code between the new scheduling class and
   the core scheduler and refines the interactions between sched/dl
   and the other existing scheduling classes.

Cc: johan.e...@ericsson.com
Cc: mi...@redhat.com
Cc: tommaso.cucino...@sssup.it
Cc: dhaval.gi...@gmail.com
Cc: liming.w...@windriver.com
Cc: nicola.man...@disi.unitn.it
Cc: rost...@goodmis.org
Cc: fweis...@gmail.com
Cc: harald.gustafs...@ericsson.com
Cc: hgu1...@gmail.com
Cc: paul...@linux.vnet.ibm.com
Cc: insop.s...@gmail.com
Cc: vincent.guit...@linaro.org
Cc: bruce.ashfi...@windriver.com
Cc: dar...@dvhart.com
Cc: jka...@redhat.com
Cc: o...@redhat.com
Cc: t...@linutronix.de
Cc: luca.ab...@unitn.it
Cc: clau...@evidence.eu.com
Cc: p.fa...@akatech.ch
Signed-off-by: Dario Faggioli <raist...@linux.it>
Signed-off-by: Michael Trimarchi <mich...@amarulasolutions.com>
Signed-off-by: Fabio Checconi <fchecc...@gmail.com>
Signed-off-by: Juri Lelli <juri.le...@gmail.com>
Signed-off-by: Peter Zijlstra <pet...@infradead.org>
---
 arch/arm/include/asm/unistd.h  |    2 
 include/linux/sched.h          |   46 ++
 include/linux/sched/deadline.h |   24 +
 include/uapi/linux/sched.h     |    1 
 kernel/fork.c                  |    4 
 kernel/hrtimer.c               |    3 
 kernel/sched/Makefile          |    3 
 kernel/sched/core.c            |  109 +++++-
 kernel/sched/deadline.c        |  684 +++++++++++++++++++++++++++++++++++++++++
 kernel/sched/sched.h           |   28 +
 kernel/sched/stop_task.c       |    2 
 11 files changed, 885 insertions(+), 21 deletions(-)
 create mode 100644 include/linux/sched/deadline.h
 create mode 100644 kernel/sched/deadline.c

--- a/include/linux/sched.h
+++ b/include/linux/sched.h
@@ -95,6 +95,10 @@ struct sched_param {
  * timing constraints.
  *
  *  @size              size of the structure, for fwd/bwd compat.
+ *
+ * As of now, the SCHED_DEADLINE policy (sched_dl scheduling class) is the
+ * only user of this new interface. More information about the algorithm
+ * available in the scheduling class file or in Documentation/.
  */
 struct sched_attr {
        int sched_priority;
@@ -1080,6 +1084,45 @@ struct sched_rt_entity {
 #endif
 };
 
+struct sched_dl_entity {
+       struct rb_node  rb_node;
+
+       /*
+        * Original scheduling parameters. Copied here from sched_attr
+        * during sched_setscheduler2(), they will remain the same until
+        * the next sched_setscheduler2().
+        */
+       u64 dl_runtime;         /* maximum runtime for each instance    */
+       u64 dl_deadline;        /* relative deadline of each instance   */
+
+       /*
+        * Actual scheduling parameters. Initialized with the values above,
+        * they are continously updated during task execution. Note that
+        * the remaining runtime could be < 0 in case we are in overrun.
+        */
+       s64 runtime;            /* remaining runtime for this instance  */
+       u64 deadline;           /* absolute deadline for this instance  */
+       unsigned int flags;     /* specifying the scheduler behaviour   */
+
+       /*
+        * Some bool flags:
+        *
+        * @dl_throttled tells if we exhausted the runtime. If so, the
+        * task has to wait for a replenishment to be performed at the
+        * next firing of dl_timer.
+        *
+        * @dl_new tells if a new instance arrived. If so we must
+        * start executing it with full runtime and reset its absolute
+        * deadline;
+        */
+       int dl_throttled, dl_new;
+
+       /*
+        * Bandwidth enforcement timer. Each -deadline task has its
+        * own bandwidth to be enforced, thus we need one timer per task.
+        */
+       struct hrtimer dl_timer;
+};
 
 struct rcu_node;
 
@@ -1116,6 +1159,7 @@ struct task_struct {
 #ifdef CONFIG_CGROUP_SCHED
        struct task_group *sched_task_group;
 #endif
+       struct sched_dl_entity dl;
 
 #ifdef CONFIG_PREEMPT_NOTIFIERS
        /* list of struct preempt_notifier: */
@@ -2093,7 +2137,7 @@ extern void wake_up_new_task(struct task
 #else
  static inline void kick_process(struct task_struct *tsk) { }
 #endif
-extern void sched_fork(unsigned long clone_flags, struct task_struct *p);
+extern int sched_fork(unsigned long clone_flags, struct task_struct *p);
 extern void sched_dead(struct task_struct *p);
 
 extern void proc_caches_init(void);
--- /dev/null
+++ b/include/linux/sched/deadline.h
@@ -0,0 +1,24 @@
+#ifndef _SCHED_DEADLINE_H
+#define _SCHED_DEADLINE_H
+
+/*
+ * SCHED_DEADLINE tasks has negative priorities, reflecting
+ * the fact that any of them has higher prio than RT and
+ * NORMAL/BATCH tasks.
+ */
+
+#define MAX_DL_PRIO            0
+
+static inline int dl_prio(int prio)
+{
+       if (unlikely(prio < MAX_DL_PRIO))
+               return 1;
+       return 0;
+}
+
+static inline int dl_task(struct task_struct *p)
+{
+       return dl_prio(p->prio);
+}
+
+#endif /* _SCHED_DEADLINE_H */
--- a/include/uapi/linux/sched.h
+++ b/include/uapi/linux/sched.h
@@ -39,6 +39,7 @@
 #define SCHED_BATCH            3
 /* SCHED_ISO: reserved but not implemented yet */
 #define SCHED_IDLE             5
+#define SCHED_DEADLINE         6
 /* Can be ORed in to make sure the process is reverted back to SCHED_NORMAL on 
fork */
 #define SCHED_RESET_ON_FORK     0x40000000
 
--- a/kernel/fork.c
+++ b/kernel/fork.c
@@ -1310,7 +1310,9 @@ static struct task_struct *copy_process(
 #endif
 
        /* Perform scheduler related setup. Assign this task to a CPU. */
-       sched_fork(clone_flags, p);
+       retval = sched_fork(clone_flags, p);
+       if (retval)
+               goto bad_fork_cleanup_policy;
 
        retval = perf_event_init_task(p);
        if (retval)
--- a/kernel/hrtimer.c
+++ b/kernel/hrtimer.c
@@ -46,6 +46,7 @@
 #include <linux/sched.h>
 #include <linux/sched/sysctl.h>
 #include <linux/sched/rt.h>
+#include <linux/sched/deadline.h>
 #include <linux/timer.h>
 #include <linux/freezer.h>
 
@@ -1610,7 +1611,7 @@ long hrtimer_nanosleep(struct timespec *
        unsigned long slack;
 
        slack = current->timer_slack_ns;
-       if (rt_task(current))
+       if (dl_task(current) || rt_task(current))
                slack = 0;
 
        hrtimer_init_on_stack(&t.timer, clockid, mode);
--- a/kernel/sched/Makefile
+++ b/kernel/sched/Makefile
@@ -11,7 +11,8 @@ ifneq ($(CONFIG_SCHED_OMIT_FRAME_POINTER
 CFLAGS_core.o := $(PROFILING) -fno-omit-frame-pointer
 endif
 
-obj-y += core.o proc.o clock.o cputime.o idle_task.o fair.o rt.o stop_task.o
+obj-y += core.o proc.o clock.o cputime.o
+obj-y += idle_task.o fair.o rt.o deadline.o stop_task.o
 obj-y += wait.o completion.o
 obj-$(CONFIG_SMP) += cpupri.o
 obj-$(CONFIG_SCHED_AUTOGROUP) += auto_group.o
--- a/kernel/sched/core.c
+++ b/kernel/sched/core.c
@@ -899,7 +899,9 @@ static inline int normal_prio(struct tas
 {
        int prio;
 
-       if (task_has_rt_policy(p))
+       if (task_has_dl_policy(p))
+               prio = MAX_DL_PRIO-1;
+       else if (task_has_rt_policy(p))
                prio = MAX_RT_PRIO-1 - p->rt_priority;
        else
                prio = __normal_prio(p);
@@ -1716,6 +1718,12 @@ static void __sched_fork(unsigned long c
        memset(&p->se.statistics, 0, sizeof(p->se.statistics));
 #endif
 
+       RB_CLEAR_NODE(&p->dl.rb_node);
+       hrtimer_init(&p->dl.dl_timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
+       p->dl.dl_runtime = p->dl.runtime = 0;
+       p->dl.dl_deadline = p->dl.deadline = 0;
+       p->dl.flags = 0;
+
        INIT_LIST_HEAD(&p->rt.run_list);
 
 #ifdef CONFIG_PREEMPT_NOTIFIERS
@@ -1767,7 +1775,7 @@ void set_numabalancing_state(bool enable
 /*
  * fork()/clone()-time setup:
  */
-void sched_fork(unsigned long clone_flags, struct task_struct *p)
+int sched_fork(unsigned long clone_flags, struct task_struct *p)
 {
        unsigned long flags;
        int cpu = get_cpu();
@@ -1789,7 +1797,7 @@ void sched_fork(unsigned long clone_flag
         * Revert to default priority/policy on fork if requested.
         */
        if (unlikely(p->sched_reset_on_fork)) {
-               if (task_has_rt_policy(p)) {
+               if (task_has_dl_policy(p) || task_has_rt_policy(p)) {
                        p->policy = SCHED_NORMAL;
                        p->static_prio = NICE_TO_PRIO(0);
                        p->rt_priority = 0;
@@ -1806,8 +1814,14 @@ void sched_fork(unsigned long clone_flag
                p->sched_reset_on_fork = 0;
        }
 
-       if (!rt_prio(p->prio))
+       if (dl_prio(p->prio)) {
+               put_cpu();
+               return -EAGAIN;
+       } else if (rt_prio(p->prio)) {
+               p->sched_class = &rt_sched_class;
+       } else {
                p->sched_class = &fair_sched_class;
+       }
 
        if (p->sched_class->task_fork)
                p->sched_class->task_fork(p);
@@ -1836,6 +1850,7 @@ void sched_fork(unsigned long clone_flag
 #endif
 
        put_cpu();
+       return 0;
 }
 
 /*
@@ -2767,7 +2782,7 @@ void rt_mutex_setprio(struct task_struct
        struct rq *rq;
        const struct sched_class *prev_class;
 
-       BUG_ON(prio < 0 || prio > MAX_PRIO);
+       BUG_ON(prio > MAX_PRIO);
 
        rq = __task_rq_lock(p);
 
@@ -2799,7 +2814,9 @@ void rt_mutex_setprio(struct task_struct
        if (running)
                p->sched_class->put_prev_task(rq, p);
 
-       if (rt_prio(prio))
+       if (dl_prio(prio))
+               p->sched_class = &dl_sched_class;
+       else if (rt_prio(prio))
                p->sched_class = &rt_sched_class;
        else
                p->sched_class = &fair_sched_class;
@@ -2833,9 +2850,9 @@ void set_user_nice(struct task_struct *p
         * The RT priorities are set via sched_setscheduler(), but we still
         * allow the 'normal' nice value to be set - but as expected
         * it wont have any effect on scheduling until the task is
-        * SCHED_FIFO/SCHED_RR:
+        * SCHED_DEADLINE, SCHED_FIFO or SCHED_RR:
         */
-       if (task_has_rt_policy(p)) {
+       if (task_has_dl_policy(p) || task_has_rt_policy(p)) {
                p->static_prio = NICE_TO_PRIO(nice);
                goto out_unlock;
        }
@@ -2999,7 +3016,9 @@ __setscheduler(struct rq *rq, struct tas
        p->normal_prio = normal_prio(p);
        /* we are holding p->pi_lock already */
        p->prio = rt_mutex_getprio(p);
-       if (rt_prio(p->prio))
+       if (dl_prio(p->prio))
+               p->sched_class = &dl_sched_class;
+       else if (rt_prio(p->prio))
                p->sched_class = &rt_sched_class;
        else
                p->sched_class = &fair_sched_class;
@@ -3007,6 +3026,50 @@ __setscheduler(struct rq *rq, struct tas
 }
 
 /*
+ * This function initializes the sched_dl_entity of a newly becoming
+ * SCHED_DEADLINE task.
+ *
+ * Only the static values are considered here, the actual runtime and the
+ * absolute deadline will be properly calculated when the task is enqueued
+ * for the first time with its new policy.
+ */
+static void
+__setparam_dl(struct task_struct *p, const struct sched_attr *attr)
+{
+       struct sched_dl_entity *dl_se = &p->dl;
+
+       init_dl_task_timer(dl_se);
+       dl_se->dl_runtime = attr->sched_runtime;
+       dl_se->dl_deadline = attr->sched_deadline;
+       dl_se->flags = attr->sched_flags;
+       dl_se->dl_throttled = 0;
+       dl_se->dl_new = 1;
+}
+
+static void
+__getparam_dl(struct task_struct *p, struct sched_attr *attr)
+{
+       struct sched_dl_entity *dl_se = &p->dl;
+
+       attr->sched_priority = p->rt_priority;
+       attr->sched_runtime = dl_se->dl_runtime;
+       attr->sched_deadline = dl_se->dl_deadline;
+       attr->sched_flags = dl_se->flags;
+}
+
+/*
+ * This function validates the new parameters of a -deadline task.
+ * We ask for the deadline not being zero, and greater or equal
+ * than the runtime.
+ */
+static bool
+__checkparam_dl(const struct sched_attr *attr)
+{
+       return attr && attr->sched_deadline != 0 &&
+              (s64)(attr->sched_deadline - attr->sched_runtime) >= 0;
+}
+
+/*
  * check the target process has a UID that matches the current process's
  */
 static bool check_same_owner(struct task_struct *p)
@@ -3043,7 +3106,8 @@ static int __sched_setscheduler(struct t
                reset_on_fork = !!(policy & SCHED_RESET_ON_FORK);
                policy &= ~SCHED_RESET_ON_FORK;
 
-               if (policy != SCHED_FIFO && policy != SCHED_RR &&
+               if (policy != SCHED_DEADLINE &&
+                               policy != SCHED_FIFO && policy != SCHED_RR &&
                                policy != SCHED_NORMAL && policy != SCHED_BATCH 
&&
                                policy != SCHED_IDLE)
                        return -EINVAL;
@@ -3058,7 +3122,8 @@ static int __sched_setscheduler(struct t
            (p->mm && attr->sched_priority > MAX_USER_RT_PRIO-1) ||
            (!p->mm && attr->sched_priority > MAX_RT_PRIO-1))
                return -EINVAL;
-       if (rt_policy(policy) != (attr->sched_priority != 0))
+       if ((dl_policy(policy) && !__checkparam_dl(attr)) ||
+           (rt_policy(policy) != (attr->sched_priority != 0)))
                return -EINVAL;
 
        /*
@@ -3124,7 +3189,8 @@ static int __sched_setscheduler(struct t
         * If not changing anything there's no need to proceed further:
         */
        if (unlikely(policy == p->policy && (!rt_policy(policy) ||
-                    attr->sched_priority == p->rt_priority))) {
+                       attr->sched_priority == p->rt_priority) &&
+                       !dl_policy(policy))) {
                task_rq_unlock(rq, p, &flags);
                return 0;
        }
@@ -3161,6 +3227,8 @@ static int __sched_setscheduler(struct t
 
        oldprio = p->prio;
        prev_class = p->sched_class;
+       if (dl_policy(policy))
+               __setparam_dl(p, attr);
        __setscheduler(rq, p, policy, attr->sched_priority);
 
        if (running)
@@ -3331,8 +3399,11 @@ do_sched_setscheduler2(pid_t pid, int po
        rcu_read_lock();
        retval = -ESRCH;
        p = find_process_by_pid(pid);
-       if (p != NULL)
+       if (p != NULL) {
+               if (dl_policy(policy))
+                       attr.sched_priority = 0;
                retval = sched_setscheduler2(p, policy, &attr);
+       }
        rcu_read_unlock();
 
        return retval;
@@ -3449,6 +3520,10 @@ SYSCALL_DEFINE2(sched_getparam, pid_t, p
        if (retval)
                goto out_unlock;
 
+       if (task_has_dl_policy(p)) {
+               retval = -EINVAL;
+               goto out_unlock;
+       }
        lp.sched_priority = p->rt_priority;
        rcu_read_unlock();
 
@@ -3506,7 +3581,7 @@ static int sched_read_attr(struct sched_
 }
 
 /**
- * sys_sched_getattr - same as above, but with extended "sched_param"
+ * sys_sched_getattr - similar to sched_getparam, but with sched_attr
  * @pid: the pid in question.
  * @attr: structure containing the extended parameters.
  * @size: sizeof(attr) for fwd/bwd comp.
@@ -3534,6 +3609,7 @@ SYSCALL_DEFINE3(sched_getattr, pid_t, pi
        if (retval)
                goto out_unlock;
 
+       __getparam_dl(p, &attr);
        attr.sched_priority = p->rt_priority;
        rcu_read_unlock();
 
@@ -3956,6 +4032,7 @@ SYSCALL_DEFINE1(sched_get_priority_max,
        case SCHED_RR:
                ret = MAX_USER_RT_PRIO-1;
                break;
+       case SCHED_DEADLINE:
        case SCHED_NORMAL:
        case SCHED_BATCH:
        case SCHED_IDLE:
@@ -3982,6 +4059,7 @@ SYSCALL_DEFINE1(sched_get_priority_min,
        case SCHED_RR:
                ret = 1;
                break;
+       case SCHED_DEADLINE:
        case SCHED_NORMAL:
        case SCHED_BATCH:
        case SCHED_IDLE:
@@ -6462,6 +6540,7 @@ void __init sched_init(void)
                rq->calc_load_update = jiffies + LOAD_FREQ;
                init_cfs_rq(&rq->cfs);
                init_rt_rq(&rq->rt, rq);
+               init_dl_rq(&rq->dl, rq);
 #ifdef CONFIG_FAIR_GROUP_SCHED
                root_task_group.shares = ROOT_TASK_GROUP_LOAD;
                INIT_LIST_HEAD(&rq->leaf_cfs_rq_list);
@@ -6646,7 +6725,7 @@ void normalize_rt_tasks(void)
                p->se.statistics.block_start    = 0;
 #endif
 
-               if (!rt_task(p)) {
+               if (!dl_task(p) && !rt_task(p)) {
                        /*
                         * Renice negative nice level userspace
                         * tasks back to 0:
--- /dev/null
+++ b/kernel/sched/deadline.c
@@ -0,0 +1,684 @@
+/*
+ * Deadline Scheduling Class (SCHED_DEADLINE)
+ *
+ * Earliest Deadline First (EDF) + Constant Bandwidth Server (CBS).
+ *
+ * Tasks that periodically executes their instances for less than their
+ * runtime won't miss any of their deadlines.
+ * Tasks that are not periodic or sporadic or that tries to execute more
+ * than their reserved bandwidth will be slowed down (and may potentially
+ * miss some of their deadlines), and won't affect any other task.
+ *
+ * Copyright (C) 2012 Dario Faggioli <raist...@linux.it>,
+ *                    Michael Trimarchi <mich...@amarulasolutions.com>,
+ *                    Fabio Checconi <fchecc...@gmail.com>
+ */
+#include "sched.h"
+
+static inline int dl_time_before(u64 a, u64 b)
+{
+       return (s64)(a - b) < 0;
+}
+
+static inline struct task_struct *dl_task_of(struct sched_dl_entity *dl_se)
+{
+       return container_of(dl_se, struct task_struct, dl);
+}
+
+static inline struct rq *rq_of_dl_rq(struct dl_rq *dl_rq)
+{
+       return container_of(dl_rq, struct rq, dl);
+}
+
+static inline struct dl_rq *dl_rq_of_se(struct sched_dl_entity *dl_se)
+{
+       struct task_struct *p = dl_task_of(dl_se);
+       struct rq *rq = task_rq(p);
+
+       return &rq->dl;
+}
+
+static inline int on_dl_rq(struct sched_dl_entity *dl_se)
+{
+       return !RB_EMPTY_NODE(&dl_se->rb_node);
+}
+
+static inline int is_leftmost(struct task_struct *p, struct dl_rq *dl_rq)
+{
+       struct sched_dl_entity *dl_se = &p->dl;
+
+       return dl_rq->rb_leftmost == &dl_se->rb_node;
+}
+
+void init_dl_rq(struct dl_rq *dl_rq, struct rq *rq)
+{
+       dl_rq->rb_root = RB_ROOT;
+}
+
+static void enqueue_task_dl(struct rq *rq, struct task_struct *p, int flags);
+static void __dequeue_task_dl(struct rq *rq, struct task_struct *p, int flags);
+static void check_preempt_curr_dl(struct rq *rq, struct task_struct *p,
+                                 int flags);
+
+/*
+ * We are being explicitly informed that a new instance is starting,
+ * and this means that:
+ *  - the absolute deadline of the entity has to be placed at
+ *    current time + relative deadline;
+ *  - the runtime of the entity has to be set to the maximum value.
+ *
+ * The capability of specifying such event is useful whenever a -deadline
+ * entity wants to (try to!) synchronize its behaviour with the scheduler's
+ * one, and to (try to!) reconcile itself with its own scheduling
+ * parameters.
+ */
+static inline void setup_new_dl_entity(struct sched_dl_entity *dl_se)
+{
+       struct dl_rq *dl_rq = dl_rq_of_se(dl_se);
+       struct rq *rq = rq_of_dl_rq(dl_rq);
+
+       WARN_ON(!dl_se->dl_new || dl_se->dl_throttled);
+
+       /*
+        * We use the regular wall clock time to set deadlines in the
+        * future; in fact, we must consider execution overheads (time
+        * spent on hardirq context, etc.).
+        */
+       dl_se->deadline = rq_clock(rq) + dl_se->dl_deadline;
+       dl_se->runtime = dl_se->dl_runtime;
+       dl_se->dl_new = 0;
+}
+
+/*
+ * Pure Earliest Deadline First (EDF) scheduling does not deal with the
+ * possibility of a entity lasting more than what it declared, and thus
+ * exhausting its runtime.
+ *
+ * Here we are interested in making runtime overrun possible, but we do
+ * not want a entity which is misbehaving to affect the scheduling of all
+ * other entities.
+ * Therefore, a budgeting strategy called Constant Bandwidth Server (CBS)
+ * is used, in order to confine each entity within its own bandwidth.
+ *
+ * This function deals exactly with that, and ensures that when the runtime
+ * of a entity is replenished, its deadline is also postponed. That ensures
+ * the overrunning entity can't interfere with other entity in the system and
+ * can't make them miss their deadlines. Reasons why this kind of overruns
+ * could happen are, typically, a entity voluntarily trying to overcome its
+ * runtime, or it just underestimated it during sched_setscheduler_ex().
+ */
+static void replenish_dl_entity(struct sched_dl_entity *dl_se)
+{
+       struct dl_rq *dl_rq = dl_rq_of_se(dl_se);
+       struct rq *rq = rq_of_dl_rq(dl_rq);
+
+       /*
+        * We keep moving the deadline away until we get some
+        * available runtime for the entity. This ensures correct
+        * handling of situations where the runtime overrun is
+        * arbitrary large.
+        */
+       while (dl_se->runtime <= 0) {
+               dl_se->deadline += dl_se->dl_deadline;
+               dl_se->runtime += dl_se->dl_runtime;
+       }
+
+       /*
+        * At this point, the deadline really should be "in
+        * the future" with respect to rq->clock. If it's
+        * not, we are, for some reason, lagging too much!
+        * Anyway, after having warn userspace abut that,
+        * we still try to keep the things running by
+        * resetting the deadline and the budget of the
+        * entity.
+        */
+       if (dl_time_before(dl_se->deadline, rq_clock(rq))) {
+               static bool lag_once = false;
+
+               if (!lag_once) {
+                       lag_once = true;
+                       printk_sched("sched: DL replenish lagged to much\n");
+               }
+               dl_se->deadline = rq_clock(rq) + dl_se->dl_deadline;
+               dl_se->runtime = dl_se->dl_runtime;
+       }
+}
+
+/*
+ * Here we check if --at time t-- an entity (which is probably being
+ * [re]activated or, in general, enqueued) can use its remaining runtime
+ * and its current deadline _without_ exceeding the bandwidth it is
+ * assigned (function returns true if it can't). We are in fact applying
+ * one of the CBS rules: when a task wakes up, if the residual runtime
+ * over residual deadline fits within the allocated bandwidth, then we
+ * can keep the current (absolute) deadline and residual budget without
+ * disrupting the schedulability of the system. Otherwise, we should
+ * refill the runtime and set the deadline a period in the future,
+ * because keeping the current (absolute) deadline of the task would
+ * result in breaking guarantees promised to other tasks.
+ *
+ * This function returns true if:
+ *
+ *   runtime / (deadline - t) > dl_runtime / dl_deadline ,
+ *
+ * IOW we can't recycle current parameters.
+ */
+static bool dl_entity_overflow(struct sched_dl_entity *dl_se, u64 t)
+{
+       u64 left, right;
+
+       /*
+        * left and right are the two sides of the equation above,
+        * after a bit of shuffling to use multiplications instead
+        * of divisions.
+        *
+        * Note that none of the time values involved in the two
+        * multiplications are absolute: dl_deadline and dl_runtime
+        * are the relative deadline and the maximum runtime of each
+        * instance, runtime is the runtime left for the last instance
+        * and (deadline - t), since t is rq->clock, is the time left
+        * to the (absolute) deadline. Even if overflowing the u64 type
+        * is very unlikely to occur in both cases, here we scale down
+        * as we want to avoid that risk at all. Scaling down by 10
+        * means that we reduce granularity to 1us. We are fine with it,
+        * since this is only a true/false check and, anyway, thinking
+        * of anything below microseconds resolution is actually fiction
+        * (but still we want to give the user that illusion >;).
+        */
+       left = (dl_se->dl_deadline >> 10) * (dl_se->runtime >> 10);
+       right = ((dl_se->deadline - t) >> 10) * (dl_se->dl_runtime >> 10);
+
+       return dl_time_before(right, left);
+}
+
+/*
+ * When a -deadline entity is queued back on the runqueue, its runtime and
+ * deadline might need updating.
+ *
+ * The policy here is that we update the deadline of the entity only if:
+ *  - the current deadline is in the past,
+ *  - using the remaining runtime with the current deadline would make
+ *    the entity exceed its bandwidth.
+ */
+static void update_dl_entity(struct sched_dl_entity *dl_se)
+{
+       struct dl_rq *dl_rq = dl_rq_of_se(dl_se);
+       struct rq *rq = rq_of_dl_rq(dl_rq);
+
+       /*
+        * The arrival of a new instance needs special treatment, i.e.,
+        * the actual scheduling parameters have to be "renewed".
+        */
+       if (dl_se->dl_new) {
+               setup_new_dl_entity(dl_se);
+               return;
+       }
+
+       if (dl_time_before(dl_se->deadline, rq_clock(rq)) ||
+           dl_entity_overflow(dl_se, rq_clock(rq))) {
+               dl_se->deadline = rq_clock(rq) + dl_se->dl_deadline;
+               dl_se->runtime = dl_se->dl_runtime;
+       }
+}
+
+/*
+ * If the entity depleted all its runtime, and if we want it to sleep
+ * while waiting for some new execution time to become available, we
+ * set the bandwidth enforcement timer to the replenishment instant
+ * and try to activate it.
+ *
+ * Notice that it is important for the caller to know if the timer
+ * actually started or not (i.e., the replenishment instant is in
+ * the future or in the past).
+ */
+static int start_dl_timer(struct sched_dl_entity *dl_se)
+{
+       struct dl_rq *dl_rq = dl_rq_of_se(dl_se);
+       struct rq *rq = rq_of_dl_rq(dl_rq);
+       ktime_t now, act;
+       ktime_t soft, hard;
+       unsigned long range;
+       s64 delta;
+
+       /*
+        * We want the timer to fire at the deadline, but considering
+        * that it is actually coming from rq->clock and not from
+        * hrtimer's time base reading.
+        */
+       act = ns_to_ktime(dl_se->deadline);
+       now = hrtimer_cb_get_time(&dl_se->dl_timer);
+       delta = ktime_to_ns(now) - rq_clock(rq);
+       act = ktime_add_ns(act, delta);
+
+       /*
+        * If the expiry time already passed, e.g., because the value
+        * chosen as the deadline is too small, don't even try to
+        * start the timer in the past!
+        */
+       if (ktime_us_delta(act, now) < 0)
+               return 0;
+
+       hrtimer_set_expires(&dl_se->dl_timer, act);
+
+       soft = hrtimer_get_softexpires(&dl_se->dl_timer);
+       hard = hrtimer_get_expires(&dl_se->dl_timer);
+       range = ktime_to_ns(ktime_sub(hard, soft));
+       __hrtimer_start_range_ns(&dl_se->dl_timer, soft,
+                                range, HRTIMER_MODE_ABS, 0);
+
+       return hrtimer_active(&dl_se->dl_timer);
+}
+
+/*
+ * This is the bandwidth enforcement timer callback. If here, we know
+ * a task is not on its dl_rq, since the fact that the timer was running
+ * means the task is throttled and needs a runtime replenishment.
+ *
+ * However, what we actually do depends on the fact the task is active,
+ * (it is on its rq) or has been removed from there by a call to
+ * dequeue_task_dl(). In the former case we must issue the runtime
+ * replenishment and add the task back to the dl_rq; in the latter, we just
+ * do nothing but clearing dl_throttled, so that runtime and deadline
+ * updating (and the queueing back to dl_rq) will be done by the
+ * next call to enqueue_task_dl().
+ */
+static enum hrtimer_restart dl_task_timer(struct hrtimer *timer)
+{
+       struct sched_dl_entity *dl_se = container_of(timer,
+                                                    struct sched_dl_entity,
+                                                    dl_timer);
+       struct task_struct *p = dl_task_of(dl_se);
+       struct rq *rq = task_rq(p);
+       raw_spin_lock(&rq->lock);
+
+       /*
+        * We need to take care of a possible races here. In fact, the
+        * task might have changed its scheduling policy to something
+        * different from SCHED_DEADLINE or changed its reservation
+        * parameters (through sched_setscheduler()).
+        */
+       if (!dl_task(p) || dl_se->dl_new)
+               goto unlock;
+
+       sched_clock_tick();
+       update_rq_clock(rq);
+       dl_se->dl_throttled = 0;
+       if (p->on_rq) {
+               enqueue_task_dl(rq, p, ENQUEUE_REPLENISH);
+               if (task_has_dl_policy(rq->curr))
+                       check_preempt_curr_dl(rq, p, 0);
+               else
+                       resched_task(rq->curr);
+       }
+unlock:
+       raw_spin_unlock(&rq->lock);
+
+       return HRTIMER_NORESTART;
+}
+
+void init_dl_task_timer(struct sched_dl_entity *dl_se)
+{
+       struct hrtimer *timer = &dl_se->dl_timer;
+
+       if (hrtimer_active(timer)) {
+               hrtimer_try_to_cancel(timer);
+               return;
+       }
+
+       hrtimer_init(timer, CLOCK_MONOTONIC, HRTIMER_MODE_REL);
+       timer->function = dl_task_timer;
+}
+
+static
+int dl_runtime_exceeded(struct rq *rq, struct sched_dl_entity *dl_se)
+{
+       int dmiss = dl_time_before(dl_se->deadline, rq_clock(rq));
+       int rorun = dl_se->runtime <= 0;
+
+       if (!rorun && !dmiss)
+               return 0;
+
+       /*
+        * If we are beyond our current deadline and we are still
+        * executing, then we have already used some of the runtime of
+        * the next instance. Thus, if we do not account that, we are
+        * stealing bandwidth from the system at each deadline miss!
+        */
+       if (dmiss) {
+               dl_se->runtime = rorun ? dl_se->runtime : 0;
+               dl_se->runtime -= rq_clock(rq) - dl_se->deadline;
+       }
+
+       return 1;
+}
+
+/*
+ * Update the current task's runtime statistics (provided it is still
+ * a -deadline task and has not been removed from the dl_rq).
+ */
+static void update_curr_dl(struct rq *rq)
+{
+       struct task_struct *curr = rq->curr;
+       struct sched_dl_entity *dl_se = &curr->dl;
+       u64 delta_exec;
+
+       if (!dl_task(curr) || !on_dl_rq(dl_se))
+               return;
+
+       /*
+        * Consumed budget is computed considering the time as
+        * observed by schedulable tasks (excluding time spent
+        * in hardirq context, etc.). Deadlines are instead
+        * computed using hard walltime. This seems to be the more
+        * natural solution, but the full ramifications of this
+        * approach need further study.
+        */
+       delta_exec = rq_clock_task(rq) - curr->se.exec_start;
+       if (unlikely((s64)delta_exec < 0))
+               delta_exec = 0;
+
+       schedstat_set(curr->se.statistics.exec_max,
+                     max(curr->se.statistics.exec_max, delta_exec));
+
+       curr->se.sum_exec_runtime += delta_exec;
+       account_group_exec_runtime(curr, delta_exec);
+
+       curr->se.exec_start = rq_clock_task(rq);
+       cpuacct_charge(curr, delta_exec);
+
+       dl_se->runtime -= delta_exec;
+       if (dl_runtime_exceeded(rq, dl_se)) {
+               __dequeue_task_dl(rq, curr, 0);
+               if (likely(start_dl_timer(dl_se)))
+                       dl_se->dl_throttled = 1;
+               else
+                       enqueue_task_dl(rq, curr, ENQUEUE_REPLENISH);
+
+               if (!is_leftmost(curr, &rq->dl))
+                       resched_task(curr);
+       }
+}
+
+static void __enqueue_dl_entity(struct sched_dl_entity *dl_se)
+{
+       struct dl_rq *dl_rq = dl_rq_of_se(dl_se);
+       struct rb_node **link = &dl_rq->rb_root.rb_node;
+       struct rb_node *parent = NULL;
+       struct sched_dl_entity *entry;
+       int leftmost = 1;
+
+       BUG_ON(!RB_EMPTY_NODE(&dl_se->rb_node));
+
+       while (*link) {
+               parent = *link;
+               entry = rb_entry(parent, struct sched_dl_entity, rb_node);
+               if (dl_time_before(dl_se->deadline, entry->deadline))
+                       link = &parent->rb_left;
+               else {
+                       link = &parent->rb_right;
+                       leftmost = 0;
+               }
+       }
+
+       if (leftmost)
+               dl_rq->rb_leftmost = &dl_se->rb_node;
+
+       rb_link_node(&dl_se->rb_node, parent, link);
+       rb_insert_color(&dl_se->rb_node, &dl_rq->rb_root);
+
+       dl_rq->dl_nr_running++;
+}
+
+static void __dequeue_dl_entity(struct sched_dl_entity *dl_se)
+{
+       struct dl_rq *dl_rq = dl_rq_of_se(dl_se);
+
+       if (RB_EMPTY_NODE(&dl_se->rb_node))
+               return;
+
+       if (dl_rq->rb_leftmost == &dl_se->rb_node) {
+               struct rb_node *next_node;
+
+               next_node = rb_next(&dl_se->rb_node);
+               dl_rq->rb_leftmost = next_node;
+       }
+
+       rb_erase(&dl_se->rb_node, &dl_rq->rb_root);
+       RB_CLEAR_NODE(&dl_se->rb_node);
+
+       dl_rq->dl_nr_running--;
+}
+
+static void
+enqueue_dl_entity(struct sched_dl_entity *dl_se, int flags)
+{
+       BUG_ON(on_dl_rq(dl_se));
+
+       /*
+        * If this is a wakeup or a new instance, the scheduling
+        * parameters of the task might need updating. Otherwise,
+        * we want a replenishment of its runtime.
+        */
+       if (!dl_se->dl_new && flags & ENQUEUE_REPLENISH)
+               replenish_dl_entity(dl_se);
+       else
+               update_dl_entity(dl_se);
+
+       __enqueue_dl_entity(dl_se);
+}
+
+static void dequeue_dl_entity(struct sched_dl_entity *dl_se)
+{
+       __dequeue_dl_entity(dl_se);
+}
+
+static void enqueue_task_dl(struct rq *rq, struct task_struct *p, int flags)
+{
+       /*
+        * If p is throttled, we do nothing. In fact, if it exhausted
+        * its budget it needs a replenishment and, since it now is on
+        * its rq, the bandwidth timer callback (which clearly has not
+        * run yet) will take care of this.
+        */
+       if (p->dl.dl_throttled)
+               return;
+
+       enqueue_dl_entity(&p->dl, flags);
+       inc_nr_running(rq);
+}
+
+static void __dequeue_task_dl(struct rq *rq, struct task_struct *p, int flags)
+{
+       dequeue_dl_entity(&p->dl);
+}
+
+static void dequeue_task_dl(struct rq *rq, struct task_struct *p, int flags)
+{
+       update_curr_dl(rq);
+       __dequeue_task_dl(rq, p, flags);
+
+       dec_nr_running(rq);
+}
+
+/*
+ * Yield task semantic for -deadline tasks is:
+ *
+ *   get off from the CPU until our next instance, with
+ *   a new runtime. This is of little use now, since we
+ *   don't have a bandwidth reclaiming mechanism. Anyway,
+ *   bandwidth reclaiming is planned for the future, and
+ *   yield_task_dl will indicate that some spare budget
+ *   is available for other task instances to use it.
+ */
+static void yield_task_dl(struct rq *rq)
+{
+       struct task_struct *p = rq->curr;
+
+       /*
+        * We make the task go to sleep until its current deadline by
+        * forcing its runtime to zero. This way, update_curr_dl() stops
+        * it and the bandwidth timer will wake it up and will give it
+        * new scheduling parameters (thanks to dl_new=1).
+        */
+       if (p->dl.runtime > 0) {
+               rq->curr->dl.dl_new = 1;
+               p->dl.runtime = 0;
+       }
+       update_curr_dl(rq);
+}
+
+/*
+ * Only called when both the current and waking task are -deadline
+ * tasks.
+ */
+static void check_preempt_curr_dl(struct rq *rq, struct task_struct *p,
+                                 int flags)
+{
+       if (dl_time_before(p->dl.deadline, rq->curr->dl.deadline))
+               resched_task(rq->curr);
+}
+
+#ifdef CONFIG_SCHED_HRTICK
+static void start_hrtick_dl(struct rq *rq, struct task_struct *p)
+{
+       s64 delta = p->dl.dl_runtime - p->dl.runtime;
+
+       if (delta > 10000)
+               hrtick_start(rq, p->dl.runtime);
+}
+#endif
+
+static struct sched_dl_entity *pick_next_dl_entity(struct rq *rq,
+                                                  struct dl_rq *dl_rq)
+{
+       struct rb_node *left = dl_rq->rb_leftmost;
+
+       if (!left)
+               return NULL;
+
+       return rb_entry(left, struct sched_dl_entity, rb_node);
+}
+
+struct task_struct *pick_next_task_dl(struct rq *rq)
+{
+       struct sched_dl_entity *dl_se;
+       struct task_struct *p;
+       struct dl_rq *dl_rq;
+
+       dl_rq = &rq->dl;
+
+       if (unlikely(!dl_rq->dl_nr_running))
+               return NULL;
+
+       dl_se = pick_next_dl_entity(rq, dl_rq);
+       BUG_ON(!dl_se);
+
+       p = dl_task_of(dl_se);
+       p->se.exec_start = rq_clock_task(rq);
+#ifdef CONFIG_SCHED_HRTICK
+       if (hrtick_enabled(rq))
+               start_hrtick_dl(rq, p);
+#endif
+       return p;
+}
+
+static void put_prev_task_dl(struct rq *rq, struct task_struct *p)
+{
+       update_curr_dl(rq);
+}
+
+static void task_tick_dl(struct rq *rq, struct task_struct *p, int queued)
+{
+       update_curr_dl(rq);
+
+#ifdef CONFIG_SCHED_HRTICK
+       if (hrtick_enabled(rq) && queued && p->dl.runtime > 0)
+               start_hrtick_dl(rq, p);
+#endif
+}
+
+static void task_fork_dl(struct task_struct *p)
+{
+       /*
+        * SCHED_DEADLINE tasks cannot fork and this is achieved through
+        * sched_fork()
+        */
+}
+
+static void task_dead_dl(struct task_struct *p)
+{
+       struct hrtimer *timer = &p->dl.dl_timer;
+
+       if (hrtimer_active(timer))
+               hrtimer_try_to_cancel(timer);
+}
+
+static void set_curr_task_dl(struct rq *rq)
+{
+       struct task_struct *p = rq->curr;
+
+       p->se.exec_start = rq_clock_task(rq);
+}
+
+static void switched_from_dl(struct rq *rq, struct task_struct *p)
+{
+       if (hrtimer_active(&p->dl.dl_timer))
+               hrtimer_try_to_cancel(&p->dl.dl_timer);
+}
+
+static void switched_to_dl(struct rq *rq, struct task_struct *p)
+{
+       /*
+        * If p is throttled, don't consider the possibility
+        * of preempting rq->curr, the check will be done right
+        * after its runtime will get replenished.
+        */
+       if (unlikely(p->dl.dl_throttled))
+               return;
+
+       if (!p->on_rq || rq->curr != p) {
+               if (task_has_dl_policy(rq->curr))
+                       check_preempt_curr_dl(rq, p, 0);
+               else
+                       resched_task(rq->curr);
+       }
+}
+
+static void prio_changed_dl(struct rq *rq, struct task_struct *p,
+                           int oldprio)
+{
+       switched_to_dl(rq, p);
+}
+
+#ifdef CONFIG_SMP
+static int
+select_task_rq_dl(struct task_struct *p, int prev_cpu, int sd_flag, int flags)
+{
+       return task_cpu(p);
+}
+#endif
+
+const struct sched_class dl_sched_class = {
+       .next                   = &rt_sched_class,
+       .enqueue_task           = enqueue_task_dl,
+       .dequeue_task           = dequeue_task_dl,
+       .yield_task             = yield_task_dl,
+
+       .check_preempt_curr     = check_preempt_curr_dl,
+
+       .pick_next_task         = pick_next_task_dl,
+       .put_prev_task          = put_prev_task_dl,
+
+#ifdef CONFIG_SMP
+       .select_task_rq         = select_task_rq_dl,
+#endif
+
+       .set_curr_task          = set_curr_task_dl,
+       .task_tick              = task_tick_dl,
+       .task_fork              = task_fork_dl,
+       .task_dead              = task_dead_dl,
+
+       .prio_changed           = prio_changed_dl,
+       .switched_from          = switched_from_dl,
+       .switched_to            = switched_to_dl,
+};
--- a/kernel/sched/sched.h
+++ b/kernel/sched/sched.h
@@ -2,6 +2,7 @@
 #include <linux/sched.h>
 #include <linux/sched/sysctl.h>
 #include <linux/sched/rt.h>
+#include <linux/sched/deadline.h>
 #include <linux/mutex.h>
 #include <linux/spinlock.h>
 #include <linux/stop_machine.h>
@@ -88,11 +89,23 @@ static inline int rt_policy(int policy)
        return 0;
 }
 
+static inline int dl_policy(int policy)
+{
+       if (unlikely(policy == SCHED_DEADLINE))
+               return 1;
+       return 0;
+}
+
 static inline int task_has_rt_policy(struct task_struct *p)
 {
        return rt_policy(p->policy);
 }
 
+static inline int task_has_dl_policy(struct task_struct *p)
+{
+       return dl_policy(p->policy);
+}
+
 /*
  * This is the priority-queue data structure of the RT scheduling class:
  */
@@ -364,6 +377,15 @@ struct rt_rq {
 #endif
 };
 
+/* Deadline class' related fields in a runqueue */
+struct dl_rq {
+       /* runqueue is an rbtree, ordered by deadline */
+       struct rb_root rb_root;
+       struct rb_node *rb_leftmost;
+
+       unsigned long dl_nr_running;
+};
+
 #ifdef CONFIG_SMP
 
 /*
@@ -432,6 +454,7 @@ struct rq {
 
        struct cfs_rq cfs;
        struct rt_rq rt;
+       struct dl_rq dl;
 
 #ifdef CONFIG_FAIR_GROUP_SCHED
        /* list of leaf cfs_rq on this cpu: */
@@ -988,6 +1011,7 @@ static const u32 prio_to_wmult[40] = {
 #else
 #define ENQUEUE_WAKING         0
 #endif
+#define ENQUEUE_REPLENISH      8
 
 #define DEQUEUE_SLEEP          1
 
@@ -1043,6 +1067,7 @@ struct sched_class {
    for (class = sched_class_highest; class; class = class->next)
 
 extern const struct sched_class stop_sched_class;
+extern const struct sched_class dl_sched_class;
 extern const struct sched_class rt_sched_class;
 extern const struct sched_class fair_sched_class;
 extern const struct sched_class idle_sched_class;
@@ -1078,6 +1103,8 @@ extern void resched_cpu(int cpu);
 extern struct rt_bandwidth def_rt_bandwidth;
 extern void init_rt_bandwidth(struct rt_bandwidth *rt_b, u64 period, u64 
runtime);
 
+extern void init_dl_task_timer(struct sched_dl_entity *dl_se);
+
 extern void update_idle_cpu_load(struct rq *this_rq);
 
 extern void init_task_runnable_average(struct task_struct *p);
@@ -1354,6 +1381,7 @@ extern void print_rt_stats(struct seq_fi
 
 extern void init_cfs_rq(struct cfs_rq *cfs_rq);
 extern void init_rt_rq(struct rt_rq *rt_rq, struct rq *rq);
+extern void init_dl_rq(struct dl_rq *dl_rq, struct rq *rq);
 
 extern void cfs_bandwidth_usage_inc(void);
 extern void cfs_bandwidth_usage_dec(void);
--- a/kernel/sched/stop_task.c
+++ b/kernel/sched/stop_task.c
@@ -103,7 +103,7 @@ get_rr_interval_stop(struct rq *rq, stru
  * Simple, special scheduling class for the per-CPU stop tasks:
  */
 const struct sched_class stop_sched_class = {
-       .next                   = &rt_sched_class,
+       .next                   = &dl_sched_class,
 
        .enqueue_task           = enqueue_task_stop,
        .dequeue_task           = dequeue_task_stop,


--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majord...@vger.kernel.org
More majordomo info at  http://vger.kernel.org/majordomo-info.html
Please read the FAQ at  http://www.tux.org/lkml/

Reply via email to