Subversion Repositories openrisc_2011-10-31

/*

 *  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: cre_sem.c,v 1.2 2001-09-27 11:59:13 chris Exp $

 */

#include <itron.h>

#include <rtems/itron/semaphore.h>

#include <rtems/itron/task.h>

#include <rtems/score/tod.h>

/*

 *  cre_sem - Create Semaphore

 *

 *  This function implements the ITRON 3.0 cre_sem() service.

 */

ER cre_sem(

  ID      semid,

  T_CSEM *pk_csem

)

{

  CORE_semaphore_Attributes   the_semaphore_attributes;

  ITRON_Semaphore_Control    *the_semaphore;

  /*

   *  Bad pointer to the attributes structure

   */

  if ( !pk_csem )

    return E_PAR;

  /*

   *  Bits were set that were note defined.

   */

  if ( pk_csem->sematr & _ITRON_SEMAPHORE_UNUSED_ATTRIBUTES )

    return E_RSATR;

  /*

   *  Initial semaphore count exceeds the maximum.

   */

  if ( pk_csem->isemcnt > pk_csem->maxsem )

    return E_PAR;

  /*

   *  This error is not in the specification but this condition

   *  does not make sense.

   */

  if ( pk_csem->maxsem == 0 )

    return E_PAR;

  _Thread_Disable_dispatch();             /* prevents deletion */

  the_semaphore = _ITRON_Semaphore_Allocate( semid );

  if ( !the_semaphore ) {

    _Thread_Enable_dispatch();

    return _ITRON_Semaphore_Clarify_allocation_id_error( semid );

  }

  if ( pk_csem->sematr & TA_TPRI )

    the_semaphore_attributes.discipline = CORE_SEMAPHORE_DISCIPLINES_PRIORITY;

  else

    the_semaphore_attributes.discipline = CORE_SEMAPHORE_DISCIPLINES_FIFO;

  the_semaphore_attributes.maximum_count = pk_csem->maxsem;

  _CORE_semaphore_Initialize(

    &the_semaphore->semaphore,

    OBJECTS_ITRON_SEMAPHORES,

    &the_semaphore_attributes,

    pk_csem->isemcnt,

    NULL                           /* Multiprocessing not supported */

  );

  _ITRON_Objects_Open( &_ITRON_Semaphore_Information, &the_semaphore->Object );

  /*

   *  If multiprocessing were supported, this is where we would announce

   *  the existence of the semaphore to the rest of the system.

   */

#if defined(RTEMS_MULTIPROCESSING)

#endif

  _Thread_Enable_dispatch();

  return E_OK;

}