263 lines
8.0 KiB
C
263 lines
8.0 KiB
C
|
/************************************************************
|
||
|
* sig_initialize.c
|
||
|
*
|
||
|
* Copyright (C) 2007 Gregory Nutt. All rights reserved.
|
||
|
* Author: Gregory Nutt <spudmonkey@racsa.co.cr>
|
||
|
*
|
||
|
* Redistribution and use in source and binary forms, with or without
|
||
|
* modification, are permitted provided that the following conditions
|
||
|
* are met:
|
||
|
*
|
||
|
* 1. Redistributions of source code must retain the above copyright
|
||
|
* notice, this list of conditions and the following disclaimer.
|
||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||
|
* notice, this list of conditions and the following disclaimer in
|
||
|
* the documentation and/or other materials provided with the
|
||
|
* distribution.
|
||
|
* 3. Neither the name Gregory Nutt nor the names of its contributors may be
|
||
|
* used to endorse or promote products derived from this software
|
||
|
* without specific prior written permission.
|
||
|
*
|
||
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
||
|
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
||
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
|
||
|
* FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
|
||
|
* COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
|
||
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
|
||
|
* BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
|
||
|
* OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
|
||
|
* AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
|
||
|
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
|
||
|
* ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||
|
* POSSIBILITY OF SUCH DAMAGE.
|
||
|
*
|
||
|
************************************************************/
|
||
|
|
||
|
/************************************************************
|
||
|
* Included Files
|
||
|
************************************************************/
|
||
|
|
||
|
#include <sys/types.h>
|
||
|
#include <queue.h>
|
||
|
#include <nuttx/kmalloc.h>
|
||
|
#include "os_internal.h"
|
||
|
#include "sig_internal.h"
|
||
|
|
||
|
/************************************************************
|
||
|
* Definitions
|
||
|
************************************************************/
|
||
|
|
||
|
/************************************************************
|
||
|
* Private Type Declarations
|
||
|
************************************************************/
|
||
|
|
||
|
/************************************************************
|
||
|
* Global Variables
|
||
|
************************************************************/
|
||
|
|
||
|
/* The g_sigfreeaction data structure is a list of available
|
||
|
* signal action structures. */
|
||
|
|
||
|
sq_queue_t g_sigfreeaction;
|
||
|
|
||
|
/* The g_sigpendingaction data structure is a list of available
|
||
|
* pending signal action structures.
|
||
|
*/
|
||
|
|
||
|
sq_queue_t g_sigpendingaction;
|
||
|
|
||
|
/* The g_sigpendingirqaction is a list of available
|
||
|
* pending signal actions that are reserved for use by
|
||
|
* interrupt handlers.
|
||
|
*/
|
||
|
|
||
|
sq_queue_t g_sigpendingirqaction;
|
||
|
|
||
|
/* The g_sigpendingsignal data structure is a list of
|
||
|
* available pending signal structures.
|
||
|
*/
|
||
|
|
||
|
sq_queue_t g_sigpendingsignal;
|
||
|
|
||
|
/* The g_sigpendingirqsignal data structure is a list
|
||
|
* of available pending signal structures that are reserved
|
||
|
* for use by interrupt handlers.
|
||
|
*/
|
||
|
|
||
|
sq_queue_t g_sigpendingirqsignal;
|
||
|
|
||
|
/************************************************************
|
||
|
* Private Variables
|
||
|
************************************************************/
|
||
|
|
||
|
/* g_sigactionalloc is a pointer to the start of the
|
||
|
* allocated blocks of signal actions.
|
||
|
*/
|
||
|
|
||
|
static sigactq_t *g_sigactionalloc;
|
||
|
|
||
|
/* g_sigpendingactionalloc is a pointer to the start of the
|
||
|
* allocated blocks of pending signal actions.
|
||
|
*/
|
||
|
|
||
|
static sigq_t *g_sigpendingactionalloc;
|
||
|
|
||
|
/* g_sigpendingirqactionalloc is a pointer to the start of
|
||
|
* the allocated block of pending signal actions.
|
||
|
*/
|
||
|
|
||
|
static sigq_t *g_sigpendingirqactionalloc;
|
||
|
|
||
|
/* g_sigpendingsignalalloc is a pointer to the start of the
|
||
|
* allocated blocks of pending signals.
|
||
|
*/
|
||
|
|
||
|
static sigpendq_t *g_sigpendingsignalalloc;
|
||
|
|
||
|
/* g_sigpendingirqsignalalloc is a pointer to the start of
|
||
|
* the allocated blocks of pending signals.
|
||
|
*/
|
||
|
|
||
|
static sigpendq_t *g_sigpendingirqsignalalloc;
|
||
|
|
||
|
/************************************************************
|
||
|
* Private Function Prototypes
|
||
|
************************************************************/
|
||
|
|
||
|
static sigq_t *sig_allocateblock(sq_queue_t *sigList, uint16 nSigs,
|
||
|
ubyte sigType);
|
||
|
static sigpendq_t *sig_allocatependingsignalblock(sq_queue_t *sigList,
|
||
|
uint16 nSigs, ubyte sigType);
|
||
|
|
||
|
/************************************************************
|
||
|
* Private Functions
|
||
|
************************************************************/
|
||
|
|
||
|
/************************************************************
|
||
|
* Function: sig_allocateblock
|
||
|
*
|
||
|
* Description:
|
||
|
* Allocate a block of pending signal actions and place them
|
||
|
* on the free list.
|
||
|
*
|
||
|
************************************************************/
|
||
|
|
||
|
static sigq_t *sig_allocateblock(sq_queue_t *sigList, uint16 nSigs,
|
||
|
ubyte sigType)
|
||
|
{
|
||
|
sigq_t *sigqalloc;
|
||
|
sigq_t *sigq;
|
||
|
int i;
|
||
|
|
||
|
/* Allocate a block of pending signal actions */
|
||
|
|
||
|
sigqalloc = (sigq_t*)kmalloc((sizeof(sigq_t)) * nSigs);
|
||
|
|
||
|
sigq = sigqalloc;
|
||
|
for (i = 0; i < nSigs; i++)
|
||
|
{
|
||
|
sigq->type = sigType;
|
||
|
sq_addlast((sq_entry_t*)sigq++, sigList);
|
||
|
}
|
||
|
|
||
|
return sigqalloc;
|
||
|
}
|
||
|
|
||
|
/************************************************************
|
||
|
* Function: sig_allocatependingsignalblock
|
||
|
*
|
||
|
* Description:
|
||
|
* Allocate a block of pending signal structures and place them
|
||
|
* on the free list.
|
||
|
************************************************************/
|
||
|
|
||
|
static sigpendq_t *sig_allocatependingsignalblock(sq_queue_t *sigList,
|
||
|
uint16 nSigs, ubyte sigType)
|
||
|
{
|
||
|
sigpendq_t *sigpendalloc;
|
||
|
sigpendq_t *sigpend;
|
||
|
int i;
|
||
|
|
||
|
/* Allocate a block of pending signal structures */
|
||
|
|
||
|
sigpendalloc =
|
||
|
(sigpendq_t*)kmalloc((sizeof(sigpendq_t)) * nSigs);
|
||
|
|
||
|
sigpend = sigpendalloc;
|
||
|
for (i = 0; i < nSigs; i++)
|
||
|
{
|
||
|
sigpend->type = sigType;
|
||
|
sq_addlast((sq_entry_t*)sigpend++, sigList);
|
||
|
}
|
||
|
|
||
|
return sigpendalloc;
|
||
|
}
|
||
|
|
||
|
/************************************************************
|
||
|
* Public Functions
|
||
|
************************************************************/
|
||
|
|
||
|
/************************************************************
|
||
|
* Function: sig_initialize
|
||
|
*
|
||
|
* Description:
|
||
|
* Perform one-time power-up initialization
|
||
|
************************************************************/
|
||
|
|
||
|
void sig_initialize(void)
|
||
|
{
|
||
|
/* Initialize free lists */
|
||
|
|
||
|
sq_init(&g_sigfreeaction);
|
||
|
sq_init(&g_sigpendingaction);
|
||
|
sq_init(&g_sigpendingirqaction);
|
||
|
sq_init(&g_sigpendingsignal);
|
||
|
sq_init(&g_sigpendingirqsignal);
|
||
|
|
||
|
/* Add a block of signal structures to each list */
|
||
|
g_sigpendingactionalloc =
|
||
|
sig_allocateblock(&g_sigpendingaction,
|
||
|
NUM_PENDING_ACTIONS,
|
||
|
SIG_ALLOC_FIXED);
|
||
|
g_sigpendingirqactionalloc =
|
||
|
sig_allocateblock(&g_sigpendingaction,
|
||
|
NUM_PENDING_INT_ACTIONS,
|
||
|
SIG_ALLOC_IRQ);
|
||
|
sig_allocateactionblock();
|
||
|
g_sigpendingsignalalloc =
|
||
|
sig_allocatependingsignalblock(&g_sigpendingsignal,
|
||
|
NUM_SIGNALS_PENDING,
|
||
|
SIG_ALLOC_FIXED);
|
||
|
g_sigpendingirqsignalalloc =
|
||
|
sig_allocatependingsignalblock(&g_sigpendingirqsignal,
|
||
|
NUM_INT_SIGNALS_PENDING,
|
||
|
SIG_ALLOC_IRQ);
|
||
|
}
|
||
|
|
||
|
/************************************************************
|
||
|
* Function: sig_allocateactionblock
|
||
|
*
|
||
|
* Description:
|
||
|
* Allocate a block of signal actions and place them
|
||
|
* on the free list.
|
||
|
************************************************************/
|
||
|
|
||
|
void sig_allocateactionblock(void)
|
||
|
{
|
||
|
sigactq_t *sigact;
|
||
|
int i;
|
||
|
|
||
|
/* Allocate a block of signal actions */
|
||
|
|
||
|
g_sigactionalloc =
|
||
|
(sigactq_t*)kmalloc((sizeof(sigactq_t)) * NUM_SIGNAL_ACTIONS);
|
||
|
|
||
|
sigact = g_sigactionalloc;
|
||
|
for (i = 0; i < NUM_SIGNAL_ACTIONS; i++)
|
||
|
{
|
||
|
sq_addlast((sq_entry_t*)sigact++, &g_sigfreeaction);
|
||
|
}
|
||
|
}
|
||
|
|
||
|
|