forked from Imagelibrary/rtems
247 lines
7.0 KiB
C
247 lines
7.0 KiB
C
/* Shm_Initialization
|
|
*
|
|
* This routine is the shared memory communications initerface
|
|
* driver initialization routine.
|
|
*
|
|
* Input parameters:
|
|
* configuration - address of configuration table
|
|
*
|
|
* Output parameters: NONE
|
|
*
|
|
* COPYRIGHT (c) 1989, 1990, 1991, 1992, 1993, 1994.
|
|
* On-Line Applications Research Corporation (OAR).
|
|
* All rights assigned to U.S. Government, 1994.
|
|
*
|
|
* This material may be reproduced by or for the U.S. Government pursuant
|
|
* to the copyright license under the clause at DFARS 252.227-7013. This
|
|
* notice must appear in all copies of this file and its derivatives.
|
|
*
|
|
* $Id$
|
|
*/
|
|
|
|
#define _SHM_INIT
|
|
|
|
#include <rtems.h>
|
|
#include <shm.h>
|
|
|
|
#include <string.h> /* memset() */
|
|
|
|
/*
|
|
* User extension to install MPCI_Fatal as a fatal error
|
|
* handler extension
|
|
*/
|
|
|
|
rtems_extensions_table MPCI_Shm_extensions;
|
|
|
|
rtems_mpci_entry Shm_Initialization(
|
|
rtems_configuration_table *configuration,
|
|
rtems_cpu_table *cpu_configuration,
|
|
rtems_multiprocessing_table *mp_configuration
|
|
|
|
)
|
|
{
|
|
rtems_unsigned32 i, all_initialized;
|
|
rtems_unsigned32 interrupt_cause, interrupt_value;
|
|
void *interrupt_address;
|
|
Shm_Node_status_control *nscb;
|
|
rtems_unsigned32 extension_id; /* for installation of MPCI_Fatal */
|
|
rtems_unsigned32 remaining_memory;
|
|
|
|
Shm_RTEMS_Configuration = configuration;
|
|
Shm_RTEMS_MP_Configuration = mp_configuration;
|
|
|
|
Shm_Local_node = Shm_RTEMS_MP_Configuration->node;
|
|
Shm_Maximum_nodes = Shm_RTEMS_MP_Configuration->maximum_nodes;
|
|
|
|
Shm_Get_configuration( Shm_Local_node, &Shm_Configuration );
|
|
|
|
Shm_Receive_message_count = 0;
|
|
Shm_Null_message_count = 0;
|
|
Shm_Interrupt_count = 0;
|
|
|
|
/*
|
|
* Set the Node Status indicators
|
|
*/
|
|
|
|
Shm_Pending_initialization =
|
|
Shm_Convert(rtems_build_name( 'P', 'E', 'N', 'D' ));
|
|
Shm_Initialization_complete =
|
|
Shm_Convert(rtems_build_name( 'C', 'O', 'M', 'P' ));
|
|
Shm_Active_node =
|
|
Shm_Convert(rtems_build_name( 'A', 'C', 'T', 'V' ));
|
|
|
|
/*
|
|
* Initialize the constants used by the Locked Queue code.
|
|
*/
|
|
|
|
Shm_Locked_queue_End_of_list = Shm_Convert( 0xffffffff );
|
|
Shm_Locked_queue_Not_on_list = Shm_Convert( 0xfffffffe );
|
|
|
|
/*
|
|
* Set the base addresses for the:
|
|
* + Node Status Table
|
|
* + Free Pool and Receive Queues
|
|
* + Envelopes
|
|
*/
|
|
|
|
Shm_Node_statuses = (Shm_Node_status_control *) START_NS_CBS;
|
|
Shm_Locked_queues = (Shm_Locked_queue_Control *) START_LQ_CBS;
|
|
Shm_Envelopes = (Shm_Envelope_control *) START_ENVELOPES;
|
|
|
|
/*
|
|
* Calculate the maximum number of envelopes which can be
|
|
* placed the remaining shared memory.
|
|
*/
|
|
|
|
remaining_memory =
|
|
((void *)Shm_Configuration->base + Shm_Configuration->length) -
|
|
((void *)Shm_Envelopes);
|
|
|
|
Shm_Maximum_envelopes = remaining_memory / sizeof( Shm_Envelope_control );
|
|
Shm_Maximum_envelopes -= 1;
|
|
|
|
/*
|
|
* Set the pointer to the receive queue for the local node.
|
|
* When we receive a node, we will get it from here before
|
|
* processing it.
|
|
*/
|
|
|
|
Shm_Local_receive_queue = &Shm_Locked_queues[ Shm_Local_node ];
|
|
Shm_Local_node_status = &Shm_Node_statuses[ Shm_Local_node ];
|
|
|
|
/*
|
|
* Convert local interrupt cause information into the
|
|
* neutral format so other nodes will be able to
|
|
* understand it.
|
|
*/
|
|
|
|
interrupt_address =
|
|
(void *) Shm_Convert( (rtems_unsigned32)Shm_Configuration->Intr.address );
|
|
interrupt_value = Shm_Convert( Shm_Configuration->Intr.value );
|
|
interrupt_cause = Shm_Convert( Shm_Configuration->Intr.length );
|
|
|
|
if ( Shm_Configuration->poll_intr == POLLED_MODE ) Shm_setclockvec();
|
|
else Shm_setvec();
|
|
|
|
if ( Shm_Is_master_node() ) {
|
|
|
|
/*
|
|
* Zero out the shared memory area.
|
|
*/
|
|
|
|
(void) memset(
|
|
(void *) Shm_Configuration->base,
|
|
0,
|
|
Shm_Configuration->length
|
|
);
|
|
|
|
/*
|
|
* Initialize all of the locked queues (the free envelope
|
|
* pool and a receive queue per node) and set all of the
|
|
* node's status so they will be waiting to initialization
|
|
* to complete.
|
|
*/
|
|
|
|
Shm_Locked_queue_Initialize( FREE_ENV_CB, FREE_ENV_POOL );
|
|
|
|
for ( i=SHM_FIRST_NODE ; i<=Shm_Maximum_nodes ; i++ ) {
|
|
Shm_Initialize_receive_queue( i );
|
|
|
|
Shm_Node_statuses[ i ].status = Shm_Pending_initialization;
|
|
Shm_Node_statuses[ i ].error = 0;
|
|
}
|
|
|
|
/*
|
|
* Initialize all of the envelopes and place them in the
|
|
* free pool.
|
|
*/
|
|
|
|
for ( i=0 ; i<Shm_Maximum_envelopes ; i++ ) {
|
|
Shm_Envelopes[ i ].index = Shm_Convert(i);
|
|
Shm_Free_envelope( &Shm_Envelopes[ i ] );
|
|
}
|
|
|
|
/*
|
|
* Initialize this node's interrupt information in the
|
|
* shared area so other nodes can interrupt us.
|
|
*/
|
|
|
|
Shm_Local_node_status->int_address = (rtems_unsigned32) interrupt_address;
|
|
Shm_Local_node_status->int_value = interrupt_value;
|
|
Shm_Local_node_status->int_length = interrupt_cause;
|
|
|
|
Shm_Local_node_status->status = Shm_Initialization_complete;
|
|
|
|
/*
|
|
* Loop until all nodes have completed initialization.
|
|
*/
|
|
|
|
do {
|
|
all_initialized = 1;
|
|
|
|
for ( i = SHM_FIRST_NODE ; i <= Shm_Maximum_nodes ; i++ )
|
|
if ( Shm_Node_statuses[ i ].status != Shm_Initialization_complete )
|
|
all_initialized = 0;
|
|
|
|
} while ( all_initialized == 0 );
|
|
|
|
/*
|
|
* Tell the other nodes we think that the system is up.
|
|
*/
|
|
|
|
for ( i = SHM_FIRST_NODE ; i <= Shm_Maximum_nodes ; i++ )
|
|
Shm_Node_statuses[ i ].status = Shm_Active_node;
|
|
|
|
} else { /* is not MASTER node */
|
|
|
|
/*
|
|
* Initialize the node status for the non-master nodes.
|
|
* Because the master node zeroes out memory, it is
|
|
* necessary for them to keep putting their values in
|
|
* the node status area until the master says they
|
|
* should become active.
|
|
*/
|
|
|
|
Shm_Local_node_status->status = Shm_Pending_initialization;
|
|
|
|
do {
|
|
|
|
if ( Shm_Local_node_status->status == Shm_Pending_initialization ) {
|
|
|
|
/*
|
|
* Initialize this node's interrupt information in the
|
|
* shared area so other nodes can interrupt us.
|
|
*/
|
|
|
|
Shm_Local_node_status->int_address =
|
|
(rtems_unsigned32) interrupt_address;
|
|
Shm_Local_node_status->int_value = interrupt_value;
|
|
Shm_Local_node_status->int_length = interrupt_cause;
|
|
|
|
Shm_Local_node_status->status = Shm_Initialization_complete;
|
|
}
|
|
} while ( Shm_Local_node_status->status != Shm_Active_node ) ;
|
|
}
|
|
|
|
/*
|
|
* Initialize the Interrupt Information Table
|
|
*/
|
|
|
|
for ( i = SHM_FIRST_NODE ; i <= Shm_Maximum_nodes ; i++ ) {
|
|
nscb = &Shm_Node_statuses[ i ];
|
|
|
|
Shm_Interrupt_table[i].address = Shm_Convert_address(
|
|
(void *)Shm_Convert(((vol_u32) nscb->int_address))
|
|
);
|
|
Shm_Interrupt_table[i].value = Shm_Convert( nscb->int_value );
|
|
Shm_Interrupt_table[i].length = Shm_Convert( nscb->int_length );
|
|
}
|
|
|
|
MPCI_Shm_extensions.fatal = MPCI_Fatal;
|
|
(void) rtems_extension_create(
|
|
rtems_build_name( 'M', 'P', 'E', 'X' ),
|
|
&MPCI_Shm_extensions,
|
|
&extension_id
|
|
);
|
|
}
|