rtu_linux_modules/swapi/swsignal.c

/************************************************************************
 * AUTHOR: NiuJiuRu
 * FILENAME: swsignal.c
 * DESCRIPTION: 信号量
 * NOTE: 主要用于状态通知
 * HISTORY:
 * 1, [2010-12-17] created by NiuJiuRu
 * 2, [2025-11-24] 替换"gettimeofday()"为"clock_gettime()", 前者会依赖系统
 *                 时间, 后者依赖单调递增时钟, 避免了系统时间变化带来的影响
 ***********************************************************************/
#include "swapi.h"
#include "swmem.h"
#include "swsignal.h"

/* 创建信号量 */
void *sw_signal_create()
{
	sem_t *sem = NULL;
	
	sem = (sem_t *)sw_heap_malloc(sizeof(sem_t));
	if(sem)
	{
		memset(sem, 0, sizeof(sem_t));
		sem_init(sem, 0, 0);
	}
	
	return sem;
}

/* 销毁信号量 */
void sw_signal_destroy(void *hSignal)
{
	sem_t *sem = (sem_t *)hSignal;
	sem_destroy(sem);
	sw_heap_free(sem);
}

/* 等待信号量, timeout(ms) = -1时表示无限等待 */
int sw_signal_wait(void *hSignal, int timeout)
{
	sem_t *sem = (sem_t *)hSignal;
	int ret;
	
	if(timeout < 0)
	{
wait_p1:
		ret = sem_wait(sem);
		if(ret < 0 && errno == EINTR) goto wait_p1;
		else return ret;
	}
	else
	{
		struct timespec ts, now;
		clock_gettime(CLOCK_MONOTONIC, &now);
		ts.tv_sec = now.tv_sec + timeout/1000;
		ts.tv_nsec = now.tv_nsec + (timeout%1000)*1000*1000;
		if(ts.tv_nsec >= (1000*1000*1000))
		{
		  ts.tv_sec += ts.tv_nsec/(1000*1000*1000);
		  ts.tv_nsec %= (1000*1000*1000);
		}
wait_p2:
		ret = sem_timedwait(sem, &ts);
		if(ret < 0 && errno == EINTR) goto wait_p2;
		else return ret;
	}
}

/* 点亮信号量 */
void sw_signal_give(void *hSignal)
{
	sem_t *sem = (sem_t *)hSignal;
	sem_post(sem);
}