/* * 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 #include #include #include #include #include #include #include /*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, OBJECTS_RTEMS_PORTS, FALSE, maximum_ports, sizeof( Dual_ported_memory_Control ), FALSE, RTEMS_MAXIMUM_NAME_LENGTH, FALSE ); } /*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( rtems_name name, void *internal_start, void *external_start, unsigned32 length, Objects_Id *id ) { register Dual_ported_memory_Control *the_port; if ( !rtems_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( rtems_name name, Objects_Id *id ) { Objects_Name_to_id_errors status; status = _Objects_Name_to_id( &_Dual_ported_memory_Information, &name, OBJECTS_SEARCH_ALL_NODES, id ); return _Status_Object_name_errors_to_status[ status ]; } /*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 */ }