/*------------------------------------------------------------------------------
--                                                                            --
--       This software is confidential and proprietary and may be used        --
--        only as expressly authorized by a licensing agreement from          --
--                                                                            --
--                            Hantro Products Oy.                             --
--                                                                            --
--                   (C) COPYRIGHT 2006 HANTRO PRODUCTS OY                    --
--                            ALL RIGHTS RESERVED                             --
--                                                                            --
--                 The entire notice above must be reproduced                 --
--                  on all copies and should not be removed.                  --
--                                                                            --
--------------------------------------------------------------------------------
--
--  Description : Locking semaphore for hardware sharing
--
------------------------------------------------------------------------------*/
#include <sys/types.h>
#include <sys/ipc.h>
#include <sys/sem.h>
#include <errno.h>
#include <unistd.h>
#include <pthread.h>
#include <semaphore.h>
#include <stdio.h>

#include "ewl_linux_lock.h"

#define SYTEM_V_SEMAPHORE

#ifdef SYTEM_V_SEMAPHORE

#ifdef _SEM_SEMUN_UNDEFINED
union semun
{
    int val;
    struct semid_ds *buf;
    unsigned short int *array;
    struct seminfo *__buf;
};
#endif

/* Obtain a binary semaphore's ID, allocating if necessary.  */
int binary_semaphore_allocation(key_t key, int nsem, int sem_flags)
{
    return semget(key, nsem, sem_flags);
}

/* Deallocate a binary semaphore.  All users must have finished their
   use.  Returns -1 on failure.  */
int binary_semaphore_deallocate(int semid)
{
    return semctl(semid, 0, IPC_RMID);
}

/* Wait on a binary semaphore.  Block until the semaphore value is
   positive, then decrement it by one.  */
int binary_semaphore_wait(int semid, int sem_num)
{
    int ret;
    struct sembuf operations[1];

    /* Use 'sem_num' semaphore from the set.  */
    operations[0].sem_num = sem_num;
    /* Decrement by 1.  */
    operations[0].sem_op = -1;
    /* Permit undo'ing.  */
    operations[0].sem_flg = SEM_UNDO;

    /* signal safe */
    do
    {
        ret = semop(semid, operations, 1);
    }
    while(ret == -1 && errno == EINTR);

    return ret;
}

/* Post to a binary semaphore: increment its value by one */
int binary_semaphore_post(int semid, int sem_num)
{
    int ret;
    struct sembuf operations[1];

    /* Use 'sem_num' semaphore from the set.  */
    operations[0].sem_num = sem_num;
    /* Increment by 1.  */
    operations[0].sem_op = 1;
    /* Permit undo'ing.  */
    operations[0].sem_flg = SEM_UNDO;

    /* signal safe */
    do
    {
        ret = semop(semid, operations, 1);
    }
    while(ret == -1 && errno == EINTR);

    return ret;
}

/* Initialize a binary semaphore with a value of one.  */
int binary_semaphore_initialize(int semid, int semnum)
{
    union semun argument;

    argument.val = 1;
    return semctl(semid, semnum, SETVAL, argument);
}

/* Get the value of a binary semaphore  */
int binary_semaphore_getval(int semid, int semnum)
{
    return semctl(semid, semnum, GETVAL);
}

#else

static sem_t sem0, sem1;
static int sem0_init = 0, sem1_init = 0;

/* Obtain a binary semaphore's ID, allocating if necessary.  */
int binary_semaphore_allocation(key_t key, int nsem, int sem_flags)
{
    if (sem0_init && sem1_init) return 0;
	else if (sem_flags & IPC_CREAT) return 0;

	errno = ENOENT;
	return -1;
}

/* Deallocate a binary semaphore.  All users must have finished their
   use.  Returns -1 on failure.  */
int binary_semaphore_deallocate(int semid)
{
 	sem_destroy(&sem0);
	sem_destroy(&sem1);
	sem0_init = 0;   
	sem1_init = 0;
	return 0;
}

/* Wait on a binary semaphore.  Block until the semaphore value is
   positive, then decrement it by one.  */
int binary_semaphore_wait(int semid, int sem_num)
{
    if (sem_num == 0) 
		return sem_wait(&sem0);
	else if (sem_num == 1)
		return sem_wait(&sem1);
	return -1;
}

/* Post to a binary semaphore: increment its value by one */
int binary_semaphore_post(int semid, int sem_num)
{
    if (sem_num == 0)
		return sem_post(&sem0);
	else if (sem_num == 1)
		return sem_post(&sem1); 
	return -1;
}

/* Initialize a binary semaphore with a value of one.  */
int binary_semaphore_initialize(int semid, int semnum)
{
	int ret = -1;
	if (semnum == 0) {
		ret = sem_init(&sem0, 0, 1);
		if (ret == 0)
			sem0_init = 1;
	}
	else if (semnum == 1) {
		ret = sem_init(&sem1, 0, 1);
		if (ret == 0)
			sem1_init = 1;
	}
	return ret;
}

/* Get the value of a binary semaphore  */
int binary_semaphore_getval(int semid, int semnum)
{
	int value = -1;
	if (semnum == 0)
		sem_getvalue(&sem0, &value);
	else if (semnum == 1)
		sem_getvalue(&sem1, &value);

	return value;
}

#endif