gqueue.c File Reference

#include <math.h>
#include <stdio.h>
#include "gqueue.h"

Include dependency graph for gqueue.c:

Go to the source code of this file.

Macros
#define	BEGIN_ATOMIC()
#define	END_ATOMIC()

Functions
int	gQUEUE_Init (PGQUEUECONTROL pQueueControl, int Size, int NReaders)
int	gQUEUE_RequestLastReadIndex (PGQUEUECONTROL pQueueControl, int NReader, int *Index)
int	gQUEUE_RequestReadIndex (PGQUEUECONTROL pQueueControl, int NReader, int *Index)
int	gQUEUE_GetReadIndex (PGQUEUECONTROL pQueueControl, int NReader, int *Index, int IndexHorizon)
int	gQUEUE_GetWriteIndex (PGQUEUECONTROL pQueueControl, int *Index, int IndexHorizon)
int	gQUEUE_RequestWriteIndex (PGQUEUECONTROL pQueueControl, int *Index)
int	gQUEUE_UnwrapReadIndex (PGQUEUECONTROL pQueueControl, int NReader)
int	gQUEUE_UnwrapWriteIndex (PGQUEUECONTROL pQueueControl)
int	gQUEUE_GetNumberOfUnreadData (PGQUEUECONTROL pQueueControl, int NReader, int *Index)

Macro Definition Documentation

#define BEGIN_ATOMIC

(

)

Definition at line 17 of file gqueue.c.

Referenced by gQUEUE_GetReadIndex(), gQUEUE_GetWriteIndex(), gQUEUE_RequestLastReadIndex(), gQUEUE_RequestReadIndex(), and gQUEUE_RequestWriteIndex().

#define END_ATOMIC

(

)

Definition at line 18 of file gqueue.c.

Referenced by gQUEUE_GetReadIndex(), gQUEUE_GetWriteIndex(), gQUEUE_RequestLastReadIndex(), gQUEUE_RequestReadIndex(), and gQUEUE_RequestWriteIndex().

Function Documentation

int gQUEUE_GetNumberOfUnreadData	(	PGQUEUECONTROL	pQueueControl,
		int	NReader,
		int *	Index
	)

Definition at line 314 of file gqueue.c.

References FALSE, GQUEUECONTROL::NReaders, GQUEUECONTROL::ReadIndex, GQUEUECONTROL::Size, TRUE, and GQUEUECONTROL::WriteIndex.

Referenced by gDataLogger_IPCUpdate(), and gDataLogger_MatfileUpdate().

{
        if(NReader>=pQueueControl->NReaders){
                return FALSE;
        }

        if(pQueueControl->WriteIndex >= pQueueControl->ReadIndex[NReader]){
                *Index = pQueueControl->WriteIndex-pQueueControl->ReadIndex[NReader];
        }
        else{
                *Index = pQueueControl->Size-(pQueueControl->ReadIndex[NReader]-pQueueControl->WriteIndex);
        }
        
        return TRUE;
}                      

Here is the caller graph for this function:

int gQUEUE_GetReadIndex	(	PGQUEUECONTROL	pQueueControl,
		int	NReader,
		int *	Index,
		int	IndexHorizon
	)

Definition at line 166 of file gqueue.c.

References BEGIN_ATOMIC, END_ATOMIC, FALSE, GQUEUECONTROL::FlagStillNotWritten, gQUEUE_UnwrapReadIndex(), GQUEUECONTROL::NReaders, GQUEUECONTROL::ReadIndex, GQUEUECONTROL::Size, and TRUE.

{
        if(NReader>=pQueueControl->NReaders){
                return FALSE;
        }

        if(pQueueControl->FlagStillNotWritten == TRUE){
                return FALSE;
        }
    
BEGIN_ATOMIC();

        *Index = (pQueueControl->ReadIndex[NReader]-IndexHorizon);
        if(*Index<0){
                *Index += pQueueControl->Size;
        }
        gQUEUE_UnwrapReadIndex(pQueueControl, NReader);

END_ATOMIC();


    return TRUE;
}                      

Here is the call graph for this function:

int gQUEUE_GetWriteIndex	(	PGQUEUECONTROL	pQueueControl,
		int *	Index,
		int	IndexHorizon
	)

Definition at line 203 of file gqueue.c.

References BEGIN_ATOMIC, END_ATOMIC, FALSE, GQUEUECONTROL::FlagStillNotWritten, gQUEUE_UnwrapWriteIndex(), GQUEUECONTROL::Size, TRUE, and GQUEUECONTROL::WriteIndex.

{

    if(pQueueControl->FlagStillNotWritten == TRUE){
        return FALSE;
    }

BEGIN_ATOMIC();
    
        *Index = (pQueueControl->WriteIndex-IndexHorizon);
        if(*Index<0){
                *Index += pQueueControl->Size;
        }
        gQUEUE_UnwrapWriteIndex(pQueueControl);

END_ATOMIC();

    return TRUE;
}                      

Here is the call graph for this function:

int gQUEUE_Init	(	PGQUEUECONTROL	pQueueControl,
		int	Size,
		int	NReaders
	)

Definition at line 31 of file gqueue.c.

References FALSE, GQUEUECONTROL::FlagFull, GQUEUECONTROL::FlagStillNotRead, GQUEUECONTROL::FlagStillNotWritten, MAXSIZE_QUEUE_READ_GATES, GQUEUECONTROL::NReaders, GQUEUECONTROL::ReadIndex, GQUEUECONTROL::Size, TRUE, and GQUEUECONTROL::WriteIndex.

Referenced by gDataLogger_DeclareVariable().

{
        int n;

        if(NReaders > MAXSIZE_QUEUE_READ_GATES){
                return FALSE;
        }

        pQueueControl->Size = Size,
        pQueueControl->NReaders = NReaders;
        pQueueControl->FlagStillNotWritten = TRUE;
        for(n=0;n<NReaders;++n){
                pQueueControl->ReadIndex[n] = 0;
                pQueueControl->FlagStillNotRead[n] = TRUE;
                pQueueControl->FlagFull[n] = FALSE;
        }
        pQueueControl->WriteIndex = 0;

#if GQUEUE_RTAI_SUPPORT
        rt_spl_init(&pQueueControl->SPLAtomicAccess);
#endif
    return TRUE;
}                      

Here is the caller graph for this function:

int gQUEUE_RequestLastReadIndex	(	PGQUEUECONTROL	pQueueControl,
		int	NReader,
		int *	Index
	)

Definition at line 67 of file gqueue.c.

References BEGIN_ATOMIC, END_ATOMIC, FALSE, GQUEUECONTROL::FlagFull, GQUEUECONTROL::FlagStillNotRead, GQUEUECONTROL::FlagStillNotWritten, gQUEUE_UnwrapReadIndex(), GQUEUECONTROL::NReaders, GQUEUECONTROL::ReadIndex, TRUE, and GQUEUECONTROL::WriteIndex.

{
        if(NReader>=pQueueControl->NReaders){
                return FALSE;
        }
        
        if(pQueueControl->FlagStillNotWritten == TRUE){
                return FALSE;
        }

BEGIN_ATOMIC();
        
        if(pQueueControl->FlagStillNotRead[NReader] == TRUE){
                pQueueControl->ReadIndex[NReader] = pQueueControl->WriteIndex;
                *Index = pQueueControl->ReadIndex[NReader];
                pQueueControl->FlagStillNotRead[NReader] = FALSE;
        }
        else{
                if(pQueueControl->ReadIndex[NReader] == pQueueControl->WriteIndex){
                        pQueueControl->FlagFull[NReader] = FALSE;       
                        *Index = -1;
                }
                else{
                        pQueueControl->ReadIndex[NReader] = pQueueControl->WriteIndex;
                        gQUEUE_UnwrapReadIndex(pQueueControl,NReader);
                        *Index = pQueueControl->ReadIndex[NReader];
                }
        }

END_ATOMIC();

        if(*Index==-1){
                return FALSE;
        }  

    return TRUE;
}                      

Here is the call graph for this function:

int gQUEUE_RequestReadIndex	(	PGQUEUECONTROL	pQueueControl,
		int	NReader,
		int *	Index
	)

Definition at line 117 of file gqueue.c.

References BEGIN_ATOMIC, END_ATOMIC, FALSE, GQUEUECONTROL::FlagFull, GQUEUECONTROL::FlagStillNotRead, GQUEUECONTROL::FlagStillNotWritten, gQUEUE_UnwrapReadIndex(), GQUEUECONTROL::NReaders, GQUEUECONTROL::ReadIndex, TRUE, and GQUEUECONTROL::WriteIndex.

Referenced by gDataLogger_IPCUpdate(), and gDataLogger_MatfileUpdate().

{
        if(NReader>=pQueueControl->NReaders){
                return FALSE;
        }

        if(pQueueControl->FlagStillNotWritten == TRUE){
                return FALSE;
        }
    
BEGIN_ATOMIC();
        if(pQueueControl->FlagStillNotRead[NReader] == TRUE){
                *Index = pQueueControl->ReadIndex[NReader];
                pQueueControl->FlagStillNotRead[NReader] = FALSE;
        }
        else{
                if(pQueueControl->ReadIndex[NReader] == pQueueControl->WriteIndex){
                        pQueueControl->FlagFull[NReader] = FALSE;       
                        *Index = -1;
                }
                else{
                        ++pQueueControl->ReadIndex[NReader];
                        gQUEUE_UnwrapReadIndex(pQueueControl,NReader);
                        *Index = pQueueControl->ReadIndex[NReader];
                }
        }
END_ATOMIC();

        if(*Index==-1){
                return FALSE;
        }  

    return TRUE;
}                      

Here is the call graph for this function:

Here is the caller graph for this function:

int gQUEUE_RequestWriteIndex	(	PGQUEUECONTROL	pQueueControl,
		int *	Index
	)

Definition at line 233 of file gqueue.c.

References BEGIN_ATOMIC, END_ATOMIC, FALSE, GQUEUECONTROL::FlagFull, GQUEUECONTROL::FlagStillNotWritten, gQUEUE_UnwrapWriteIndex(), GQUEUECONTROL::NReaders, GQUEUECONTROL::ReadIndex, GQUEUECONTROL::Size, TRUE, and GQUEUECONTROL::WriteIndex.

Referenced by gDataLogger_InsertVariable().

{
        int n;
        int     FlagNotFull = TRUE;

BEGIN_ATOMIC();
    
    if(pQueueControl->FlagStillNotWritten == TRUE){
        *Index = pQueueControl->WriteIndex;
        pQueueControl->FlagStillNotWritten = FALSE;
        }
    else{
                /* Increment write index in two positions to test if queue is full */
        pQueueControl->WriteIndex += 2; 
        gQUEUE_UnwrapWriteIndex(pQueueControl);
        
                for(n=0;n<pQueueControl->NReaders;++n){    
                        if(pQueueControl->ReadIndex[n] == pQueueControl->WriteIndex){
                                pQueueControl->FlagFull[n] = TRUE;
                                FlagNotFull = FALSE;
                        }
                }

                /* Decrement write index of one position to return to the correct state */
        pQueueControl->WriteIndex += pQueueControl->Size-1; 
        gQUEUE_UnwrapWriteIndex(pQueueControl);

                *Index = pQueueControl->WriteIndex;
    }

END_ATOMIC();

    return FlagNotFull;
}                      

Here is the call graph for this function:

Here is the caller graph for this function:

int gQUEUE_UnwrapReadIndex	(	PGQUEUECONTROL	pQueueControl,
		int	NReader
	)

Definition at line 277 of file gqueue.c.

References FALSE, GQUEUECONTROL::NReaders, GQUEUECONTROL::ReadIndex, GQUEUECONTROL::Size, and TRUE.

Referenced by gQUEUE_GetReadIndex(), gQUEUE_RequestLastReadIndex(), and gQUEUE_RequestReadIndex().

{
        if(NReader>=pQueueControl->NReaders){
                return FALSE;
        }

        pQueueControl->ReadIndex[NReader] = (pQueueControl->ReadIndex[NReader]) % (pQueueControl->Size); 
  
        return TRUE;
}                      

Here is the caller graph for this function:

int gQUEUE_UnwrapWriteIndex

(

PGQUEUECONTROL

pQueueControl

)

Definition at line 297 of file gqueue.c.

References GQUEUECONTROL::Size, TRUE, and GQUEUECONTROL::WriteIndex.

Referenced by gQUEUE_GetWriteIndex(), and gQUEUE_RequestWriteIndex().

{
        pQueueControl->WriteIndex = (pQueueControl->WriteIndex) % (pQueueControl->Size); 
        
        return TRUE;
}                      

Here is the caller graph for this function: