URL
https://opencores.org/ocsvn/openrisc_me/openrisc_me/trunk
Subversion Repositories openrisc_me
[/] [openrisc/] [trunk/] [rtos/] [rtems/] [c/] [src/] [lib/] [libbsp/] [shmdr/] [init.c] - Rev 30
Go to most recent revision | Compare with Previous | Blame | View Log
/* Shm_Initialization * * This routine is the shared memory communications initerface * driver initialization routine. * * Input parameters: NONE * * Output parameters: NONE * * COPYRIGHT (c) 1989-1999. * On-Line Applications Research Corporation (OAR). * * The license and distribution terms for this file may be * found in the file LICENSE in this distribution or at * http://www.OARcorp.com/rtems/license.html. * * $Id: init.c,v 1.2 2001-09-27 12:01:12 chris Exp $ */ #define _SHM_INIT #include <rtems.h> #include <shm_driver.h> #include <string.h> /* memset() */ #include <stdlib.h> /* malloc() */ #include <assert.h> /* * User extension to install MPCI_Fatal as a fatal error * handler extension */ rtems_extensions_table MPCI_Shm_extensions; rtems_mpci_entry Shm_Initialization( void ) { 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; /* XXX these should use "public" methods to set their values.... */ rtems_configuration_table *configuration = _Configuration_Table; rtems_multiprocessing_table *mp_configuration = _Configuration_MP_table; 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_Interrupt_table = (Shm_Interrupt_information *) malloc( sizeof(Shm_Interrupt_information) * (Shm_Maximum_nodes + 1) ); assert( Shm_Interrupt_table ); 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 ); }
Go to most recent revision | Compare with Previous | Blame | View Log