/*
* Dual Port Memory Manager
*
* 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$
*/
#include <rtems/system.h>
#include <rtems/address.h>
#include <rtems/dpmem.h>
#include <rtems/object.h>
#include <rtems/thread.h>
/*PAGE
*
* _Dual_ported_memory_Manager_initialization
*
* This routine initializes all dual-ported memory manager related
* data structures.
*
* Input parameters:
* maximum_ports - number of ports to initialize
*
* Output parameters: NONE
*/
void _Dual_ported_memory_Manager_initialization(
unsigned32 maximum_ports
)
{
_Objects_Initialize_information(
&_Dual_ported_memory_Information,
FALSE,
maximum_ports,
sizeof( Dual_ported_memory_Control )
);
}
/*PAGE
*
* rtems_port_create
*
* This directive creates a port into a dual-ported memory area.
*
* Input parameters:
* name - user defined port name
* internal_start - internal start address of port
* external_start - external start address of port
* length - physical length in bytes
* id - address of port id to set
*
* Output parameters:
* id - port id
* RTEMS_SUCCESSFUL - if successful
* error code - if unsuccessful
*/
rtems_status_code rtems_port_create(
Objects_Name name,
void *internal_start,
void *external_start,
unsigned32 length,
Objects_Id *id
)
{
register Dual_ported_memory_Control *the_port;
if ( !_Objects_Is_name_valid( name) )
return ( RTEMS_INVALID_NAME );
if ( !_Addresses_Is_aligned( internal_start ) ||
!_Addresses_Is_aligned( external_start ) )
return( RTEMS_INVALID_ADDRESS );
_Thread_Disable_dispatch(); /* to prevent deletion */
the_port = _Dual_ported_memory_Allocate();
if ( !the_port ) {
_Thread_Enable_dispatch();
return( RTEMS_TOO_MANY );
}
the_port->internal_base = internal_start;
the_port->external_base = external_start;
the_port->length = length - 1;
_Objects_Open( &_Dual_ported_memory_Information,
&the_port->Object, name );
*id = the_port->Object.id;
_Thread_Enable_dispatch();
return( RTEMS_SUCCESSFUL );
}
/*PAGE
*
* rtems_port_ident
*
* This directive returns the system ID associated with
* the port name.
*
* Input parameters:
* name - user defined port name
* id - pointer to port id
*
* Output parameters:
* *id - port id
* RTEMS_SUCCESSFUL - if successful
* error code - if unsuccessful
*/
rtems_status_code rtems_port_ident(
Objects_Name name,
Objects_Id *id
)
{
return(
_Objects_Name_to_id(
&_Dual_ported_memory_Information,
name,
RTEMS_SEARCH_ALL_NODES,
id
)
);
}
/*PAGE
*
* rtems_port_delete
*
* This directive allows a thread to delete a dual-ported memory area
* specified by the dual-ported memory identifier.
*
* Input parameters:
* id - dual-ported memory area id
*
* Output parameters:
* RTEMS_SUCCESSFUL - if successful
* error code - if unsuccessful
*/
rtems_status_code rtems_port_delete(
Objects_Id id
)
{
register Dual_ported_memory_Control *the_port;
Objects_Locations location;
the_port = _Dual_ported_memory_Get( id, &location );
switch ( location ) {
case OBJECTS_ERROR:
return( RTEMS_INVALID_ID );
case OBJECTS_REMOTE: /* this error cannot be returned */
return( RTEMS_INTERNAL_ERROR );
case OBJECTS_LOCAL:
_Objects_Close( &_Dual_ported_memory_Information, &the_port->Object );
_Dual_ported_memory_Free( the_port );
_Thread_Enable_dispatch();
return( RTEMS_SUCCESSFUL );
}
return( RTEMS_INTERNAL_ERROR ); /* unreached - only to remove warnings */
}
/*PAGE
*
* rtems_port_internal_to_external
*
* This directive converts an internal dual-ported memory address to an
* external dual-ported memory address. If the given internal address
* is an invalid dual-ported address, then the external address is set
* to the given internal address.
*
* Input parameters:
* id - id of dual-ported memory object
* internal - internal address to set
* external - pointer to external address
*
* Output parameters:
* external - external address
* RTEMS_SUCCESSFUL - always succeeds
*/
rtems_status_code rtems_port_internal_to_external(
Objects_Id id,
void *internal,
void **external
)
{
register Dual_ported_memory_Control *the_port;
Objects_Locations location;
unsigned32 ending;
the_port = _Dual_ported_memory_Get( id, &location );
switch ( location ) {
case OBJECTS_ERROR:
return( RTEMS_INVALID_ID );
case OBJECTS_REMOTE: /* this error cannot be returned */
return( RTEMS_INTERNAL_ERROR );
case OBJECTS_LOCAL:
ending = _Addresses_Subtract( internal, the_port->internal_base );
if ( ending > the_port->length )
*external = internal;
else
*external = _Addresses_Add_offset( the_port->external_base,
ending );
_Thread_Enable_dispatch();
return( RTEMS_SUCCESSFUL );
}
return( RTEMS_INTERNAL_ERROR ); /* unreached - only to remove warnings */
}
/*PAGE
*
* rtems_port_external_to_internal
*
* This directive converts an external dual-ported memory address to an
* internal dual-ported memory address. If the given external address
* is an invalid dual-ported address, then the internal address is set
* to the given external address.
*
* Input parameters:
* id - id of dp memory object
* external - external address
* internal - pointer of internal address to set
*
* Output parameters:
* internal - internal address
* RTEMS_SUCCESSFUL - always succeeds
*/
rtems_status_code rtems_port_external_to_internal(
Objects_Id id,
void *external,
void **internal
)
{
register Dual_ported_memory_Control *the_port;
Objects_Locations location;
unsigned32 ending;
the_port = _Dual_ported_memory_Get( id, &location );
switch ( location ) {
case OBJECTS_ERROR:
return( RTEMS_INVALID_ID );
case OBJECTS_REMOTE: /* this error cannot be returned */
return( RTEMS_INTERNAL_ERROR );
case OBJECTS_LOCAL:
ending = _Addresses_Subtract( external, the_port->external_base );
if ( ending > the_port->length )
*internal = external;
else
*internal = _Addresses_Add_offset( the_port->internal_base,
ending );
_Thread_Enable_dispatch();
return( RTEMS_SUCCESSFUL );
}
return( RTEMS_INTERNAL_ERROR ); /* unreached - only to remove warnings */
}