view src/gpf2/osl/os_sem_fl.c @ 627:4a8dacbe9187

targets/*.h: #define GPIO1_SPEAKER_CTRL to 0 or 1 as appropriate
author Mychaela Falconia <falcon@freecalypso.org>
date Mon, 23 Dec 2019 07:12:10 +0000
parents 27db9775cbab
children
line wrap: on
line source

/*
 * This C module is a reconstruction based on the disassembly of
 * os_sem.obj in frame_na7_db_fl.lib from the Leonardo package.
 */

/* set of included headers from COFF symtab: */
#include <stdio.h>
#include <string.h>
#include "nucleus.h"
#include "typedefs.h"
#include "os.h"
#include "gdi.h"
#include "os_types.h"
#include "os_glob.h"

extern T_OS_SEM_TABLE_ENTRY SemTable[];

static NU_SEMAPHORE SemSemCB;

static int
os_GetSemaphoreEntry(USHORT Index, OS_HANDLE *Handle)
{
	static USHORT Idx;

	if (Index == FIRST_ENTRY)
		Idx = 0;
	if (Index == FIRST_ENTRY || Index == NEXT_ENTRY) {
		for (;;) {
			Idx++;
			if (Idx > MaxSemaphores)
				return(OS_ERROR);
			if (SemTable[Idx].Name[0])
				break;
		}
	} else
		Idx = Index;
	if (Idx > MaxSemaphores)
		return(OS_ERROR);
	if (SemTable[Idx].Name[0]) {
		*Handle = Idx;
		return(OS_OK);
	} else
		return(OS_ERROR);
}

GLOBAL LONG
os_SemaphoreInformation(USHORT Index, char *Buffer)
{
	OS_HANDLE Handle;
	OPTION SuspendType;
	UNSIGNED Current, TasksWaiting;
	NU_TASK *First;
	CHAR Name[NU_MAX_NAME];

	if (os_GetSemaphoreEntry(Index, &Handle) < 0)
		return(OS_ERROR);
	if (NU_Semaphore_Information(&SemTable[Handle].SemCB, Name, &Current,
				     &SuspendType, &TasksWaiting, &First)
			!= NU_SUCCESS)
		return(OS_ERROR);
	sprintf(Buffer, "Semname:%s Count:%ld Suspend:%d Waiting:%ld", Name,
		Current, SuspendType, TasksWaiting);
	return(OS_OK);
}

GLOBAL LONG
os_SemInit(void)
{
	USHORT i;

	if (NU_Create_Semaphore(&SemSemCB, "SEMSEM", 1, NU_PRIORITY)
			!= NU_SUCCESS)
		return(OS_ERROR);
	for (i = 1; i <= MaxSemaphores; i++)
		memset(&SemTable[i], 0, sizeof(T_OS_SEM_TABLE_ENTRY));
	return(OS_OK);
}

GLOBAL LONG
os_ResetSemaphore(OS_HANDLE TaskHandle, OS_HANDLE SemHandle,
		  USHORT init_counter)
{
	STATUS sts;

	sts = NU_Obtain_Semaphore(&SemSemCB, NU_SUSPEND);
	if (!SemTable[SemHandle].Name[0]) {
error_out:	if (sts == NU_SUCCESS)
			NU_Release_Semaphore(&SemSemCB);
		return(OS_ERROR);
	}
	if (NU_Reset_Semaphore(&SemTable[SemHandle].SemCB, init_counter)
			!= NU_SUCCESS)
		goto error_out;
	if (sts == NU_SUCCESS)
		NU_Release_Semaphore(&SemSemCB);
	return(OS_OK);
}

GLOBAL LONG
os_QuerySemaphore(OS_HANDLE TaskHandle, OS_HANDLE SemHandle, USHORT *Count)
{
	OPTION SuspendType;
	UNSIGNED SemCount, TasksWaiting;
	NU_TASK *First;
	CHAR Name[NU_MAX_NAME];

	if (NU_Semaphore_Information(&SemTable[SemHandle].SemCB, Name,
				     &SemCount, &SuspendType, &TasksWaiting,
				     &First) != NU_SUCCESS)
		return(OS_ERROR);
	*Count = SemCount;
	return(OS_OK);
}

GLOBAL LONG
os_OpenSemaphore(OS_HANDLE TaskHandle, char *Name, OS_HANDLE *SemHandle)
{
	USHORT i;

	for (i = 1; i <= MaxSemaphores; i++) {
		if (!SemTable[i].Name[0])
			continue;
		if (strncmp(Name, SemTable[i].Name, RESOURCE_NAMELEN-1))
			continue;
		*SemHandle = i;
		return(OS_OK);
	}
	return(OS_ERROR);
}

GLOBAL unsigned char *
os_FindSuspendingSema(unsigned int *tcb)
{
	USHORT i;
	SM_SUSPEND *susp, *susp_loopchk;

	for (i = 1; i <= MaxSemaphores; i++) {
		if (!SemTable[i].Name[0])
			continue;
		susp = SemTable[i].SemCB.sm_suspension_list;
		if (!susp)
			continue;
		if (susp->sm_suspended_task == (NU_TASK *)tcb)
			return((unsigned char *) SemTable[i].SemCB.sm_name);
		susp = (SM_SUSPEND *)susp->sm_suspend_link.cs_next;
		for (susp_loopchk = susp; susp != susp_loopchk;
		     susp = (SM_SUSPEND *)susp->sm_suspend_link.cs_next)
			if (susp->sm_suspended_task == (NU_TASK *)tcb)
				return((unsigned char *)
					SemTable[i].SemCB.sm_name);
	}
	return(0);
}

GLOBAL LONG
os_DestroySemaphore(OS_HANDLE TaskHandle, OS_HANDLE SemHandle)
{
	STATUS sts;

	sts = NU_Obtain_Semaphore(&SemSemCB, NU_SUSPEND);
	if (!SemTable[SemHandle].Name[0]) {
error_out:	if (sts == NU_SUCCESS)
			NU_Release_Semaphore(&SemSemCB);
		return(OS_ERROR);
	}
	if (NU_Delete_Semaphore(&SemTable[SemHandle].SemCB) != NU_SUCCESS)
		goto error_out;
	SemTable[SemHandle].Name[0] = 0;
	if (sts == NU_SUCCESS)
		NU_Release_Semaphore(&SemSemCB);
	return(OS_OK);
}

GLOBAL LONG
os_CreateSemaphore(OS_HANDLE TaskHandle, char *Name, USHORT Count,
		   OS_HANDLE *SemHandle, OS_HANDLE MemPoolHandle)
{
	USHORT i;
	STATUS sts;

	if (os_OpenSemaphore(TaskHandle, Name, SemHandle) == OS_OK)
		return(OS_ERROR);
	sts = NU_Obtain_Semaphore(&SemSemCB, NU_SUSPEND);
	for (i = 1; i <= MaxSemaphores; i++) {
		if (SemTable[i].Name[0])
			continue;
		if (NU_Create_Semaphore(&SemTable[i].SemCB, Name, Count,
					NU_PRIORITY) != NU_SUCCESS)
			break;
		strncpy(SemTable[i].Name, Name, RESOURCE_NAMELEN);
		SemTable[i].Name[RESOURCE_NAMELEN-1] = 0;
		*SemHandle = i;
		if (sts == NU_SUCCESS)
			NU_Release_Semaphore(&SemSemCB);
		return(OS_OK);
	}
	if (sts == NU_SUCCESS)
		NU_Release_Semaphore(&SemSemCB);
	return(OS_ERROR);
}

GLOBAL LONG
os_CloseSemaphore(OS_HANDLE TaskHandle, OS_HANDLE SemHandle)
{
	return(OS_OK);
}