forked from Imagelibrary/rtems
08d9760daf
This emphasizes that the scheduler node of a thread is returned and this is not a function working with scheduler nodes like the other *_Node_*() functions.
68 lines
1.8 KiB
C
68 lines
1.8 KiB
C
/**
|
|
* @file
|
|
*
|
|
* @brief Attach Scheduler CBS Thread
|
|
* @ingroup ScoreScheduler
|
|
*/
|
|
|
|
/*
|
|
* 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.org/license/LICENSE.
|
|
*/
|
|
|
|
#if HAVE_CONFIG_H
|
|
#include "config.h"
|
|
#endif
|
|
|
|
#include <rtems/score/schedulercbsimpl.h>
|
|
#include <rtems/score/threadimpl.h>
|
|
|
|
int _Scheduler_CBS_Attach_thread (
|
|
Scheduler_CBS_Server_id server_id,
|
|
rtems_id task_id
|
|
)
|
|
{
|
|
Objects_Locations location;
|
|
Thread_Control *the_thread;
|
|
|
|
if ( server_id >= _Scheduler_CBS_Maximum_servers )
|
|
return SCHEDULER_CBS_ERROR_INVALID_PARAMETER;
|
|
|
|
/* Server is not valid. */
|
|
if ( !_Scheduler_CBS_Server_list[server_id].initialized )
|
|
return SCHEDULER_CBS_ERROR_NOSERVER;
|
|
|
|
/* Server is already attached to a thread. */
|
|
if ( _Scheduler_CBS_Server_list[server_id].task_id != -1 )
|
|
return SCHEDULER_CBS_ERROR_FULL;
|
|
|
|
the_thread = _Thread_Get(task_id, &location);
|
|
/* The routine _Thread_Get may disable dispatch and not enable again. */
|
|
if ( the_thread ) {
|
|
Scheduler_CBS_Node *node = _Scheduler_CBS_Thread_get_node( the_thread );
|
|
|
|
/* Thread is already attached to a server. */
|
|
if ( node->cbs_server ) {
|
|
_Objects_Put( &the_thread->Object );
|
|
return SCHEDULER_CBS_ERROR_FULL;
|
|
}
|
|
|
|
_Scheduler_CBS_Server_list[server_id].task_id = task_id;
|
|
node->cbs_server = &_Scheduler_CBS_Server_list[server_id];
|
|
|
|
the_thread->budget_callout = _Scheduler_CBS_Budget_callout;
|
|
the_thread->budget_algorithm = THREAD_CPU_BUDGET_ALGORITHM_CALLOUT;
|
|
the_thread->is_preemptible = true;
|
|
|
|
_Objects_Put( &the_thread->Object );
|
|
} else {
|
|
return SCHEDULER_CBS_ERROR_INVALID_PARAMETER;
|
|
}
|
|
|
|
return SCHEDULER_CBS_OK;
|
|
}
|