/* BEGIN_ICS_COPYRIGHT5 ****************************************

Copyright (c) 2015-2017, Intel Corporation

Redistribution and use in source and binary forms, with or without
modification, are permitted provided that the following conditions are met:

    * Redistributions of source code must retain the above copyright notice,
      this list of conditions and the following disclaimer.
    * Redistributions in binary form must reproduce the above copyright
      notice, this list of conditions and the following disclaimer in the
      documentation and/or other materials provided with the distribution.
    * Neither the name of Intel Corporation nor the names of its contributors
      may be used to endorse or promote products derived from this software
      without specific prior written permission.

THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE ARE
DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE
FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY,
OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE
OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.

 * ** END_ICS_COPYRIGHT5   ****************************************/

/***********************************************************************
* 
* FILE NAME
*      cs_sema.c
*
* DESCRIPTION
*      This file contains the implementation of the Counting Semaphores
*      services.
*
* DATA STRUCTURES
*
* FUNCTIONS
*      cs_sema_create
*      cs_sema_delete
*      cs_vsema
*      cs_psema
*
* DEPENDENCIES
*      cs_g.h
*
*
* HISTORY
*
* NAME      DATE        REMARKS
* MGR       03/14/02    Initial creation of file.
* MGR       03/26/02    Corrected lint errors.
* MGR       04/18/02    PR1728.  vs_psema should return VSTATUS_AGAIN
*                       error code, if thread has been killed.
* MGR       04/23/02    PR1742.  Added fix for blocking of cs_psema;
*                       cs_vsema should release lock if count goes to 1.
*
***********************************************************************/
#include "ib_types.h"
#include "ib_status.h"
#include "cs_g.h"
#include "vs_g.h"
#include "cs_log.h"
#define function __FUNCTION__
#ifdef __LINUX__
#include <semaphore.h>
#elif defined(__VXWORKS__) 
#include <drv/timer/timerDev.h>
#endif
#ifdef LOCAL_MOD_ID
#undef LOCAL_MOD_ID
#endif
#define LOCAL_MOD_ID VIEO_CS_MOD_ID


/**********************************************************************
*
* FUNCTION
*    cs_sema_create
*
* DESCRIPTION
*    Initialize a counting semaphore object for use.
*
* INPUTS
*    handle   - A pointer to a semaphore object to be filled in by
*               the routine.
*    count    - The initial value for the semaphore.
*
* OUTPUTS
*    Status_t - On success VSTATUS_OK is returned, otherwise
*    the cause of the error.
*
*
* HISTORY
*
*   NAME    DATE        REMARKS
*   MGR     03/14/02    Initial creation of function.
*
**********************************************************************/
Status_t
cs_sema_create (Sema_t *handle,
                    uint32_t count)
{
  Status_t          rc;

  IB_ENTER (function,
            (unint)handle,
            (uint32_t)count,
            (uint32_t)0U,
	    (uint32_t)0U);

  /*
  ** Validate handle
  */
  if (handle == (Sema_t *) 0)
  {
    IB_LOG_ERROR0 ("NULL handle pointer");
    IB_EXIT (function, VSTATUS_ILLPARM);
    return VSTATUS_ILLPARM;
  }

#ifdef __VXWORKS__
  handle->magic = SEMAPHORE_MAGIC;
  handle->semId = semCCreate(SEM_Q_FIFO, count);
  handle->count = count;
  if (!handle->semId)
  {
      IB_LOG_ERROR0 ("failed to allocate semaphore");
      rc = VSTATUS_ILLPARM;
      IB_EXIT(function, rc);
      return rc;
  }
#else
  // LINUX USER SEMA
  handle->magic = SEMAPHORE_MAGIC;
  if (sem_init((sem_t *)&handle->osdSema, 0, 0) != 0)
  {
      IB_LOG_ERROR0 ("failed to allocate semaphore");
      rc = VSTATUS_ILLPARM;
      IB_EXIT(function, rc);
      return rc;
  }
#endif // vxworks

  IB_EXIT (function, VSTATUS_OK);
  return VSTATUS_OK;
}

/**********************************************************************
*
* FUNCTION
*    cs_sema_delete
*
* DESCRIPTION
*    Delete a counting semaphore object.
*
* INPUTS
*    handle   - A pointer to a semaphore object filled in by the
*               cs_sema_create() call.
*
* OUTPUTS
*    Status_t - On success VSTATUS_OK is returned, otherwise
*    the cause of the error.
*
*
* HISTORY
*
*   NAME    DATE        REMARKS
*   MGR     03/14/02    Initial creation of function.
*
**********************************************************************/
Status_t
cs_sema_delete (Sema_t *handle)
{
  Status_t          rc;

  IB_ENTER (function,
            (unint)handle,
            (uint32_t)0U,
            (uint32_t)0U,
            (uint32_t)0U);

  /*
  ** Validate handle
  */
  if (handle == (Sema_t *) 0)
  {
    IB_LOG_ERROR0 ("NULL handle pointer");
    IB_EXIT (function, VSTATUS_ILLPARM);
    return VSTATUS_ILLPARM;
  }

  if (handle->magic != SEMAPHORE_MAGIC)
  {
    IB_LOG_ERRORX ("Invalid semaphore specified:", handle->magic);
    IB_EXIT (function, VSTATUS_NXIO);
    return VSTATUS_NXIO;
  }

#ifdef __VXWORKS__
  if (!handle->semId)
  {
      IB_LOG_ERROR0 ("NULL semaphore");
      rc = VSTATUS_ILLPARM;
      IB_EXIT(function, rc);
      return rc;
  }
  if (ERROR == semDelete(handle->semId))
  {
      IB_LOG_ERROR0 ("failed to delete semaphore");
      rc = VSTATUS_ILLPARM;
      IB_EXIT(function, rc);
      return rc;
  }
  handle->semId = NULL;
  handle->count = 0;
#else
  // LINUX USER SEMA
  if (sem_destroy((sem_t *)&handle->osdSema) != 0) {
      IB_LOG_ERROR0 ("failed to delete semaphore");
      rc = VSTATUS_ILLPARM;
      IB_EXIT(function, rc);
      return rc;
  }
  memset((void *)&handle->osdSema, 0, sizeof(sem_t));
#endif

  IB_LOG_INFO ("semaphore deleted", (unint)handle);

  IB_EXIT (function, VSTATUS_OK);
  return VSTATUS_OK;
}

/**********************************************************************
*
* FUNCTION
*    cs_vsema
*
* DESCRIPTION
*    Increment a semaphore (post or give operation)
*
* INPUTS
*    handle   - A pointer to a semaphore object filled in by the
*               cs_sema_create() call.
*
* OUTPUTS
*    Status_t - On success VSTATUS_OK is returned, otherwise
*    the cause of the error.
*
*
* HISTORY
*
*   NAME    DATE        REMARKS
*   MGR     03/14/02    Initial creation of function.
*   MGR     04/23/02    PR1742.  Added fix for blocking or cs_psema;
*                       cs_vsema should release lock if count goes to 1.
*
**********************************************************************/
Status_t
cs_vsema (Sema_t *handle)
{
  Status_t          rc;

  IB_ENTER (function,
            (unint)handle,
            (uint32_t)0U,
            (uint32_t)0U,
            (uint32_t)0U);

  /*
  ** Validate handle
  */
  if (handle == (Sema_t *) 0)
  {
    IB_LOG_ERROR0 ("NULL handle pointer");
    IB_EXIT (function, VSTATUS_ILLPARM);
    return VSTATUS_ILLPARM;
  }

  if (handle->magic != SEMAPHORE_MAGIC)
  {
    IB_LOG_ERRORX ("Invalid semaphore specified:", handle->magic);
    IB_EXIT (function, VSTATUS_NXIO);
    return VSTATUS_NXIO;
  }

#ifdef __VXWORKS__
  if (ERROR == semGive(handle->semId))
  {
      IB_LOG_ERROR0 ("Failed to give semaphore");
      rc = VSTATUS_NXIO;
      IB_EXIT(function, rc);
      return rc;
  }
  handle->count++;
#else
  // LINUX USER SEMA
  if (sem_post((sem_t *)&handle->osdSema) != 0) {
      IB_LOG_ERROR0 ("Failed to give/post semaphore");
      rc = VSTATUS_NXIO;
      IB_EXIT(function, rc);
      return rc;
  }
#endif

  IB_EXIT (function, VSTATUS_OK);
  return VSTATUS_OK;
}

/**********************************************************************
*
* FUNCTION
*    cs_psema
*
* DESCRIPTION
*    Decrement a semaphore (wait or take operation)
*
* INPUTS
*    handle   - A pointer to a semaphore object filled in by the
*               cs_sema_create() call.
*
* OUTPUTS
*    Status_t - On success VSTATUS_OK is returned, otherwise
*    the cause of the error.
*
*
* HISTORY
*
*   NAME    DATE        REMARKS
*   MGR     03/14/02    Initial creation of function.
*   MGR     04/18/02    PR1728.  vs_psema should return VSTATUS_AGAIN
*                       error code, if thread has been killed.
*
**********************************************************************/
Status_t
cs_psema_wait (Sema_t *handle, int timeout)
{
	Status_t          rc=VSTATUS_OK;

	IB_ENTER (function, (unint)handle, 0U, 0U, 0U);

  	/* Validate handle */
  	if (handle == (Sema_t *) 0)
  	{
    	IB_LOG_ERROR0 ("NULL handle pointer");
    	IB_EXIT (function, VSTATUS_ILLPARM);
    	return VSTATUS_ILLPARM;
  	}

  	if (handle->magic != SEMAPHORE_MAGIC)
  	{
    	IB_LOG_ERRORX ("Invalid semaphore specified:", handle->magic);
    	IB_EXIT (function, VSTATUS_NXIO);
    	return VSTATUS_NXIO;
  	}

  	if (timeout == CS_SEMA_WAIT_FOREVER) {
		return(cs_psema(handle));
  	} else {
#ifdef __VXWORKS__
  		if (ERROR == semTake(handle->semId, timeout*sysClkRateGet()))
  		{
      		IB_LOG_WARN0("Timed out trying to take semaphore");
      		rc = VSTATUS_NXIO;
  		} else {
            handle->count--;
        }
#elif defined (__LINUX__)
  		// LINUX USER SEMA
		int i=0, rc=-1;
		do {
  			rc = sem_trywait((sem_t *)&handle->osdSema);
			++i;
			(void)vs_thread_sleep(VTIMER_1S);
		} while (i<timeout && rc);
  		if (rc != 0) {
      		IB_LOG_WARN0("Timed out trying to take semaphore");
      		rc = VSTATUS_NXIO;
  		}
#endif
	}
  	IB_EXIT (function, rc);
    return rc;
}

/**********************************************************************
*
* FUNCTION
*    cs_psema
*
* DESCRIPTION
*    Decrement a semaphore (wait or take operation)
*
* INPUTS
*    handle   - A pointer to a semaphore object filled in by the
*               cs_sema_create() call.
*
* OUTPUTS
*    Status_t - On success VSTATUS_OK is returned, otherwise
*    the cause of the error.
*
*
* HISTORY
*
*   NAME    DATE        REMARKS
*   MGR     03/14/02    Initial creation of function.
*   MGR     04/18/02    PR1728.  vs_psema should return VSTATUS_AGAIN
*                       error code, if thread has been killed.
*
**********************************************************************/
Status_t
cs_psema (Sema_t *handle)
{
  Status_t          rc;

  IB_ENTER (function,
            (unint)handle,
            (uint32_t)0U,
            (uint32_t)0U,
            (uint32_t)0U);

  /*
  ** Validate handle
  */
  if (handle == (Sema_t *) 0)
  {
    IB_LOG_ERROR0 ("NULL handle pointer");
    IB_EXIT (function, VSTATUS_ILLPARM);
    return VSTATUS_ILLPARM;
  }

  if (handle->magic != SEMAPHORE_MAGIC)
  {
    IB_LOG_ERRORX ("Invalid semaphore specified:", handle->magic);
    IB_EXIT (function, VSTATUS_NXIO);
    return VSTATUS_NXIO;
  }

#ifdef __VXWORKS__
  if (ERROR == semTake(handle->semId, WAIT_FOREVER))
  {
      IB_LOG_ERROR0 ("Failed to take semaphore");
      rc = VSTATUS_NXIO;
      IB_EXIT(function, rc);
      return rc;
  }
  handle->count--;
#else
  // LINUX USER SEMA
  if (sem_wait((sem_t *)&handle->osdSema) != 0) {
      IB_LOG_ERROR0 ("Failed to take semaphore");
      rc = VSTATUS_NXIO;
      IB_EXIT(function, rc);
      return rc;
  }
#endif

  IB_EXIT (function, VSTATUS_OK);
  return VSTATUS_OK;
}

/**********************************************************************
*
* FUNCTION
*    cs_sema_getcount
*
* DESCRIPTION
*    return counting semaphore count
*
* INPUTS
*    handle   - A pointer to a semaphore object filled in by the
*               cs_sema_create() call.
*
* OUTPUTS
*    int - semaphore count
*
*
* HISTORY
*
*   NAME    DATE        REMARKS
*   JMS     02/20/07    Initial creation of function.
*
**********************************************************************/
Status_t cs_sema_getcount(Sema_t *handle, int *semCount)
{
	Status_t rc = VSTATUS_OK;

	IB_ENTER (function, (unint)handle, 0U, 0U, 0U);

  	/* Validate handle */
  	if (handle == (Sema_t *) 0) {
    	IB_LOG_ERROR0 ("NULL handle pointer");
    	rc = VSTATUS_ILLPARM;
  	} else if (handle->magic != SEMAPHORE_MAGIC) {
    	IB_LOG_ERRORX ("Invalid semaphore specified:", handle->magic);
    	rc = VSTATUS_NXIO;
  	} else {
#ifdef __VXWORKS__
        *semCount = handle->count;
#elif defined (__LINUX__)
        if ((sem_getvalue((sem_t *)&handle->osdSema, semCount)) != 0)
        {
            IB_LOG_ERROR0 ("Failed to get semaphore count");
            rc = VSTATUS_NXIO;
        }
#endif
    }
    IB_EXIT (function, rc);
    return rc;
}