FreeCalypso > hg > freecalypso-citrine
diff nucleus/smf.c @ 0:75a11d740a02
initial import of gsm-fw from freecalypso-sw rev 1033:5ab737ac3ad7
author | Mychaela Falconia <falcon@freecalypso.org> |
---|---|
date | Thu, 09 Jun 2016 00:02:41 +0000 |
parents | |
children |
line wrap: on
line diff
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/nucleus/smf.c Thu Jun 09 00:02:41 2016 +0000 @@ -0,0 +1,373 @@ +/*************************************************************************/ +/* */ +/* Copyright Mentor Graphics Corporation 2002 */ +/* All Rights Reserved. */ +/* */ +/* THIS WORK CONTAINS TRADE SECRET AND PROPRIETARY INFORMATION WHICH IS */ +/* THE PROPERTY OF MENTOR GRAPHICS CORPORATION OR ITS LICENSORS AND IS */ +/* SUBJECT TO LICENSE TERMS. */ +/* */ +/*************************************************************************/ + +/*************************************************************************/ +/* */ +/* FILE NAME VERSION */ +/* */ +/* smf.c Nucleus PLUS 1.14 */ +/* */ +/* COMPONENT */ +/* */ +/* SM - Semaphore Management */ +/* */ +/* DESCRIPTION */ +/* */ +/* This file contains routines to obtain facts about the Semaphore */ +/* Management component. */ +/* */ +/* DATA STRUCTURES */ +/* */ +/* None */ +/* */ +/* FUNCTIONS */ +/* */ +/* SMF_Established_Semaphores Number of created semaphores */ +/* SMF_Semaphore_Pointers Build semaphore pointer list */ +/* SMF_Semaphore_Information Retrieve semaphore info */ +/* */ +/* DEPENDENCIES */ +/* */ +/* cs_extr.h Common Service functions */ +/* tc_extr.h Thread Control functions */ +/* sm_extr.h Semaphore functions */ +/* hi_extr.h History functions */ +/* */ +/* HISTORY */ +/* */ +/* DATE REMARKS */ +/* */ +/* 03-01-1994 Initial version of semaphore */ +/* fact service file, version 1.1 */ +/* */ +/* 03-18-1994 Verified version 1.1 */ +/* 04-17-1996 updated to version 1.2 */ +/* 11-18-1996 Protected Informational service */ +/* from NULL Control Block pointers */ +/* creating 1.2a. (SPR220) */ +/* 03-24-1998 Released version 1.3 */ +/* 03-26-1999 Released 1.11m (new release */ +/* numbering scheme) */ +/* 04-17-2002 Released version 1.13m */ +/* 11-07-2002 Released version 1.14 */ +/*************************************************************************/ +#define NU_SOURCE_FILE + + +#include "cs_extr.h" /* Common service functions */ +#include "tc_extr.h" /* Thread control functions */ +#include "sm_extr.h" /* Semaphore functions */ +#include "hi_extr.h" /* History functions */ + + +/* Define external inner-component global data references. */ + +extern CS_NODE *SMD_Created_Semaphores_List; +extern UNSIGNED SMD_Total_Semaphores; +extern TC_PROTECT SMD_List_Protect; + + + +/*************************************************************************/ +/* */ +/* FUNCTION */ +/* */ +/* SMF_Established_Semaphores */ +/* */ +/* DESCRIPTION */ +/* */ +/* This function returns the current number of established */ +/* semaphores. Semaphores previously deleted are no longer */ +/* considered established. */ +/* */ +/* CALLED BY */ +/* */ +/* Application */ +/* */ +/* CALLS */ +/* */ +/* [TCT_Check_Stack] Stack checking function */ +/* */ +/* INPUTS */ +/* */ +/* None */ +/* */ +/* OUTPUTS */ +/* */ +/* SMD_Total_Semaphores Number of established */ +/* semaphores */ +/* */ +/* HISTORY */ +/* */ +/* DATE REMARKS */ +/* */ +/* 03-01-1993 Created initial version 1.0 */ +/* 04-19-1993 Verified version 1.0 */ +/* 03-01-1994 Modified function interface, */ +/* resulting in version 1.1 */ +/* */ +/* 03-18-1994 Verified version 1.1 */ +/* */ +/*************************************************************************/ +UNSIGNED SMF_Established_Semaphores(VOID) +{ + + +#ifdef NU_ENABLE_STACK_CHECK + + /* Call stack checking function to check for an overflow condition. */ + TCT_Check_Stack(); + +#endif + + /* Return the number of established semaphores. */ + return(SMD_Total_Semaphores); +} + + +/*************************************************************************/ +/* */ +/* FUNCTION */ +/* */ +/* SMF_Semaphore_Pointers */ +/* */ +/* DESCRIPTION */ +/* */ +/* This function builds a list of semaphore pointers, starting at */ +/* the specified location. The number of semaphore pointers */ +/* placed in the list is equivalent to the total number of */ +/* semaphores or the maximum number of pointers specified in the */ +/* call. */ +/* */ +/* CALLED BY */ +/* */ +/* Application */ +/* */ +/* CALLS */ +/* */ +/* [TCT_Check_Stack] Stack checking function */ +/* TCT_Protect Protect created list */ +/* TCT_Unprotect Release protection */ +/* */ +/* INPUTS */ +/* */ +/* pointer_list Pointer to the list area */ +/* maximum_pointers Maximum number of pointers */ +/* */ +/* OUTPUTS */ +/* */ +/* pointers Number of semaphores placed */ +/* in the list */ +/* HISTORY */ +/* */ +/* DATE REMARKS */ +/* */ +/* 03-01-1993 Created initial version 1.0 */ +/* 04-19-1993 Verified version 1.0 */ +/* 08-09-1993 Corrected pointer retrieval */ +/* loop, resulting in version 1.0a */ +/* 08-09-1993 Verified version 1.0a */ +/* 03-01-1994 Modified function interface, */ +/* resulting in version 1.1 */ +/* */ +/* 03-18-1994 Verified version 1.1 */ +/* */ +/*************************************************************************/ +UNSIGNED SMF_Semaphore_Pointers(NU_SEMAPHORE **pointer_list, + UNSIGNED maximum_pointers) +{ +CS_NODE *node_ptr; /* Pointer to each SMB */ +UNSIGNED pointers; /* Number of pointers in list*/ +NU_SUPERV_USER_VARIABLES + + /* Switch to supervisor mode */ + NU_SUPERVISOR_MODE(); + +#ifdef NU_ENABLE_STACK_CHECK + + /* Call stack checking function to check for an overflow condition. */ + TCT_Check_Stack(); + +#endif + + /* Initialize the number of pointers returned. */ + pointers = 0; + + /* Protect against access to the list of created semaphores. */ + TCT_Protect(&SMD_List_Protect); + + /* Loop until all semaphore pointers are in the list or until the maximum + list size is reached. */ + node_ptr = SMD_Created_Semaphores_List; + while ((node_ptr) && (pointers < maximum_pointers)) + { + + /* Place the node into the destination list. */ + *pointer_list++ = (NU_SEMAPHORE *) node_ptr; + + /* Increment the pointers variable. */ + pointers++; + + /* Position the node pointer to the next node. */ + node_ptr = node_ptr -> cs_next; + + /* Determine if the pointer is at the head of the list. */ + if (node_ptr == SMD_Created_Semaphores_List) + + /* The list search is complete. */ + node_ptr = NU_NULL; + } + + /* Release protection against access to the list of created semaphores. */ + TCT_Unprotect(); + + /* Return to user mode */ + NU_USER_MODE(); + + /* Return the number of pointers in the list. */ + return(pointers); +} + + +/*************************************************************************/ +/* */ +/* FUNCTION */ +/* */ +/* SMF_Semaphore_Information */ +/* */ +/* DESCRIPTION */ +/* */ +/* This function returns information about the specified semaphore. */ +/* However, if the supplied semaphore pointer is invalid, the */ +/* function simply returns an error status. */ +/* */ +/* CALLED BY */ +/* */ +/* Application */ +/* */ +/* CALLS */ +/* */ +/* [TCT_Check_Stack] Stack checking function */ +/* TCT_System_Protect Protect semaphore */ +/* TCT_Unprotect Release protection */ +/* */ +/* INPUTS */ +/* */ +/* semaphore_ptr Pointer to the semaphore */ +/* name Destination for the name */ +/* current_count Destination for semaphore */ +/* instance count */ +/* suspend_type Destination for the type of */ +/* suspension */ +/* tasks_waiting Destination for the tasks */ +/* waiting count */ +/* first_task Destination for the pointer */ +/* to the first task waiting */ +/* */ +/* OUTPUTS */ +/* */ +/* NU_SUCCESS If a valid semaphore pointer */ +/* is supplied */ +/* NU_INVALID_SEMAPHORE If semaphore pointer invalid */ +/* */ +/* HISTORY */ +/* */ +/* DATE REMARKS */ +/* */ +/* 03-01-1993 Created initial version 1.0 */ +/* 04-19-1993 Verified version 1.0 */ +/* 03-01-1994 Modified function interface, */ +/* resulting in version 1.1 */ +/* */ +/* 03-18-1994 Verified version 1.1 */ +/* 11-18-1996 Corrected SPR220. */ +/* */ +/*************************************************************************/ +STATUS SMF_Semaphore_Information(NU_SEMAPHORE *semaphore_ptr, CHAR *name, + UNSIGNED *current_count, OPTION *suspend_type, + UNSIGNED *tasks_waiting, NU_TASK **first_task) +{ + +SM_SCB *semaphore; /* Semaphore control blk ptr */ +INT i; /* Working integer variable */ +STATUS completion; /* Completion status */ +NU_SUPERV_USER_VARIABLES + + /* Switch to supervisor mode */ + NU_SUPERVISOR_MODE(); + + /* Move input semaphore pointer into internal pointer. */ + semaphore = (SM_SCB *) semaphore_ptr; + + +#ifdef NU_ENABLE_STACK_CHECK + + /* Call stack checking function to check for an overflow condition. */ + TCT_Check_Stack(); + +#endif + + /* Determine if this semaphore id is valid. */ + if ((semaphore != NU_NULL) && (semaphore -> sm_id == SM_SEMAPHORE_ID)) + { + + /* Setup protection of the semaphore. */ + TCT_System_Protect(); + + /* The semaphore pointer is valid. Reflect this in the completion + status and fill in the actual information. */ + completion = NU_SUCCESS; + + /* Copy the semaphore's name. */ + for (i = 0; i < NU_MAX_NAME; i++) + *name++ = semaphore -> sm_name[i]; + + /* Determine the suspension type. */ + if (semaphore -> sm_fifo_suspend) + *suspend_type = NU_FIFO; + else + *suspend_type = NU_PRIORITY; + + /* Return the current semaphore available instance count. */ + *current_count = semaphore -> sm_semaphore_count; + + /* Retrieve the number of tasks waiting and the pointer to the + first task waiting. */ + *tasks_waiting = semaphore -> sm_tasks_waiting; + if (semaphore -> sm_suspension_list) + + /* There is a task waiting. */ + *first_task = (NU_TASK *) + (semaphore -> sm_suspension_list) -> sm_suspended_task; + else + + /* There are no tasks waiting. */ + *first_task = NU_NULL; + + /* Release protection of the semaphore. */ + TCT_Unprotect(); + } + else + + /* Indicate that the semaphore pointer is invalid. */ + completion = NU_INVALID_SEMAPHORE; + + /* Return to user mode */ + NU_USER_MODE(); + + /* Return the appropriate completion status. */ + return(completion); +} + + + + +