1 files changed, 59 insertions, 0 deletions
diff --git a/cpukit/score/src/schedulercbs.c b/cpukit/score/src/schedulercbs.c
new file mode 100644
index 0000000000..dba4925b8d
--- /dev/null
+++ b/cpukit/score/src/schedulercbs.c
@@ -0,0 +1,59 @@
+/*
+ *  Copyright (C) 2011 Petr Benes.
+ *  Copyright (C) 2011 On-Line Applications Research Corporation (OAR).
+ *
+ *  The license and distribution terms for this file may be
+ *  found in the file LICENSE in this distribution or at
+ *  http://www.rtems.com/license/LICENSE.
+ *
+ *  $Id$
+ */
+
+#if HAVE_CONFIG_H
+#include "config.h"
+#endif
+
+#include <rtems/system.h>
+#include <rtems/config.h>
+#include <rtems/score/scheduler.h>
+#include <rtems/score/schedulercbs.h>
+#include <rtems/rtems/signal.h>
+
+void _Scheduler_CBS_Budget_callout(
+  Thread_Control *the_thread
+)
+{
+  Priority_Control          new_priority;
+  Scheduler_CBS_Per_thread *sched_info;
+  Scheduler_CBS_Server_id   server_id;
+
+  /* Put violating task to background until the end of period. */
+  new_priority = the_thread->Start.initial_priority;
+  if ( the_thread->real_priority != new_priority )
+    the_thread->real_priority = new_priority;
+  if ( the_thread->current_priority != new_priority )
+    _Thread_Change_priority(the_thread, new_priority, true);
+
+  /* Invoke callback function if any. */
+  sched_info = (Scheduler_CBS_Per_thread *) the_thread->scheduler_info;
+  if ( sched_info->cbs_server->cbs_budget_overrun ) {
+    _Scheduler_CBS_Get_server_id(
+        sched_info->cbs_server->task_id,
+        &server_id
+    );
+    sched_info->cbs_server->cbs_budget_overrun( server_id );
+  }
+}
+
+int _Scheduler_CBS_Initialize(void)
+{
+  unsigned int i;
+  _Scheduler_CBS_Server_list = (Scheduler_CBS_Server **) _Workspace_Allocate(
+      _Scheduler_CBS_Maximum_servers * sizeof(Scheduler_CBS_Server*) );
+  if ( !_Scheduler_CBS_Server_list )
+    return SCHEDULER_CBS_ERROR_NO_MEMORY;
+  for (i = 0; i<_Scheduler_CBS_Maximum_servers; i++) {
+    _Scheduler_CBS_Server_list[i] = NULL;
+  }
+  return SCHEDULER_CBS_OK;
+}