Subversion Repositories openrisc_2011-10-31

/*

 *  rtems_task_variable_add - Add a per-task variable

 *

 *

 *  COPYRIGHT (c) 1989-1999.

 *  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.OARcorp.com/rtems/license.html.

 *

 *  $Id: taskvariableadd.c,v 1.2 2001-09-27 11:59:19 chris Exp $

 */

#include <rtems/system.h>

#include <rtems/rtems/tasks.h>

#include <rtems/score/wkspace.h>

/*

 *  rtems_task_variable_add

 *

 *  This directive registers a task variable.

 */

rtems_status_code rtems_task_variable_add(

  rtems_id tid,

  void **ptr,

  void (*dtor)(void *)

)

{

  Thread_Control        *the_thread;

  Objects_Locations      location;

  rtems_task_variable_t *tvp, *new;

  the_thread = _Thread_Get (tid, &location);

  switch (location) {

  case OBJECTS_REMOTE:

#if defined(RTEMS_MULTIPROCESSING)

    _Thread_Dispatch();

    return RTEMS_ILLEGAL_ON_REMOTE_OBJECT;

#endif

  case OBJECTS_ERROR:

    return RTEMS_INVALID_ID;

  default:

    return RTEMS_INTERNAL_ERROR;

  case OBJECTS_LOCAL:

    /*

     *  Figure out if the variable is already in this task's list.

     */

    tvp = the_thread->task_variables;

    while (tvp) {

      if (tvp->ptr == ptr) {

        tvp->dtor = dtor;

        _Thread_Enable_dispatch();

        return RTEMS_SUCCESSFUL;

      }

      tvp = tvp->next;

    }

    /*

     *  Now allocate memory for this task variable.

     */

    new = (rtems_task_variable_t *)

       _Workspace_Allocate(sizeof(rtems_task_variable_t));

    if (new == NULL) {

      _Thread_Enable_dispatch();

      return RTEMS_NO_MEMORY;

    }

    new->gval = *ptr;

    new->ptr = ptr;

    new->dtor = dtor;

    new->next = the_thread->task_variables;

    the_thread->task_variables = new;

    _Thread_Enable_dispatch();

    return RTEMS_SUCCESSFUL;

  }

  return RTEMS_INTERNAL_ERROR;   /* unreached - only to remove warnings */

}