Intravision/reactos
1
0
Fork 0
mirror of https://github.com/reactos/reactos.git synced 2024-09-18 16:52:54 +00:00
Code Issues Packages Projects Releases Wiki Activity
reactos/drivers/bus/acpi/resource/rsaddr.c
Art Yerkes c501d8112c Create a branch for network fixes. 
svn path=/branches/aicom-network-fixes/; revision=34994
2008-08-01 11:32:26 +00:00

801 lines
20 KiB
C
Raw Blame History

/*******************************************************************************
*
* Module Name: rsaddr - Acpi_rs_address16_resource
* Acpi_rs_address16_stream
* Acpi_rs_address32_resource
* Acpi_rs_address32_stream
* $Revision: 1.1 $
*
******************************************************************************/
/*
* Copyright (C) 2000, 2001 R. Byron Moore
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful,
* but WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
* GNU General Public License for more details.
*
* You should have received a copy of the GNU General Public License
* along with this program; if not, write to the Free Software
* Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
*/
#include <acpi.h>
#define _COMPONENT ACPI_RESOURCES
MODULE_NAME ("rsaddr")
/*******************************************************************************
*
* FUNCTION: Acpi_rs_address16_resource
*
* PARAMETERS: Byte_stream_buffer - Pointer to the resource input byte
* stream
* Bytes_consumed - u32 pointer that is filled with
* the number of bytes consumed from
* the Byte_stream_buffer
* Output_buffer - Pointer to the user's return buffer
* Structure_size - u32 pointer that is filled with
* the number of bytes in the filled
* in structure
*
* RETURN: Status AE_OK if okay, else a valid ACPI_STATUS code
*
* DESCRIPTION: Take the resource byte stream and fill out the appropriate
* structure pointed to by the Output_buffer. Return the
* number of bytes consumed from the byte stream.
*
******************************************************************************/
ACPI_STATUS
acpi_rs_address16_resource (
u8 *byte_stream_buffer,
u32 *bytes_consumed,
u8 **output_buffer,
u32 *structure_size)
{
u8 *buffer = byte_stream_buffer;
RESOURCE *output_struct = (RESOURCE *) * output_buffer;
u16 temp16;
u8 temp8;
u32 index;
u32 struct_size = sizeof(ADDRESS16_RESOURCE) +
RESOURCE_LENGTH_NO_DATA;
/*
* Point past the Descriptor to get the number of bytes consumed
*/
buffer += 1;
MOVE_UNALIGNED16_TO_16 (&temp16, buffer);
*bytes_consumed = temp16 + 3;
output_struct->id = address16;
output_struct->length = struct_size;
/*
* Get the Resource Type (Byte3)
*/
buffer += 2;
temp8 = *buffer;
/* Values 0-2 are valid */
if (temp8 > 2) {
return (AE_AML_ERROR);
}
output_struct->data.address16.resource_type = temp8 & 0x03;
/*
* Get the General Flags (Byte4)
*/
buffer += 1;
temp8 = *buffer;
/*
* Producer / Consumer
*/
output_struct->data.address16.producer_consumer = temp8 & 0x01;
/*
* Decode
*/
output_struct->data.address16.decode = (temp8 >> 1) & 0x01;
/*
* Min Address Fixed
*/
output_struct->data.address16.min_address_fixed = (temp8 >> 2) & 0x01;
/*
* Max Address Fixed
*/
output_struct->data.address16.max_address_fixed = (temp8 >> 3) & 0x01;
/*
* Get the Type Specific Flags (Byte5)
*/
buffer += 1;
temp8 = *buffer;
if (MEMORY_RANGE == output_struct->data.address16.resource_type) {
output_struct->data.address16.attribute.memory.read_write_attribute =
(u16) (temp8 & 0x01);
output_struct->data.address16.attribute.memory.cache_attribute =
(u16) ((temp8 >> 1) & 0x0F);
}
else {
if (IO_RANGE == output_struct->data.address16.resource_type) {
output_struct->data.address16.attribute.io.range_attribute =
(u16) (temp8 & 0x03);
}
else {
/* BUS_NUMBER_RANGE == Address32_data->Resource_type */
/* Nothing needs to be filled in */
}
}
/*
* Get Granularity (Bytes 6-7)
*/
buffer += 1;
MOVE_UNALIGNED16_TO_16 (&output_struct->data.address16.granularity,
buffer);
/*
* Get Min_address_range (Bytes 8-9)
*/
buffer += 2;
MOVE_UNALIGNED16_TO_16 (&output_struct->data.address16.min_address_range,
buffer);
/*
* Get Max_address_range (Bytes 10-11)
*/
buffer += 2;
MOVE_UNALIGNED16_TO_16
(&output_struct->data.address16.max_address_range,
buffer);
/*
* Get Address_translation_offset (Bytes 12-13)
*/
buffer += 2;
MOVE_UNALIGNED16_TO_16
(&output_struct->data.address16.address_translation_offset,
buffer);
/*
* Get Address_length (Bytes 14-15)
*/
buffer += 2;
MOVE_UNALIGNED16_TO_16
(&output_struct->data.address16.address_length,
buffer);
/*
* Resource Source Index (if present)
*/
buffer += 2;
/*
* This will leave us pointing to the Resource Source Index
* If it is present, then save it off and calculate the
* pointer to where the null terminated string goes:
* Each Interrupt takes 32-bits + the 5 bytes of the
* stream that are default.
*/
if (*bytes_consumed > 16) {
/* Dereference the Index */
temp8 = *buffer;
output_struct->data.address16.resource_source_index =
(u32) temp8;
/* Point to the String */
buffer += 1;
/* Copy the string into the buffer */
index = 0;
while (0x00 != *buffer) {
output_struct->data.address16.resource_source[index] =
*buffer;
buffer += 1;
index += 1;
}
/*
* Add the terminating null
*/
output_struct->data.address16.resource_source[index] = 0x00;
output_struct->data.address16.resource_source_string_length =
index + 1;
/*
* In order for the Struct_size to fall on a 32-bit boundry,
* calculate the length of the string and expand the
* Struct_size to the next 32-bit boundry.
*/
temp8 = (u8) (index + 1);
struct_size += ROUND_UP_TO_32_bITS (temp8);
output_struct->length = struct_size;
}
else {
output_struct->data.address16.resource_source_index = 0x00;
output_struct->data.address16.resource_source_string_length = 0;
output_struct->data.address16.resource_source[0] = 0x00;
}
/*
* Return the final size of the structure
*/
*structure_size = struct_size;
return (AE_OK);
}
/*******************************************************************************
*
* FUNCTION: Acpi_rs_address16_stream
*
* PARAMETERS: Linked_list - Pointer to the resource linked list
* Output_buffer - Pointer to the user's return buffer
* Bytes_consumed - u32 pointer that is filled with
* the number of bytes of the
* Output_buffer used
*
* RETURN: Status AE_OK if okay, else a valid ACPI_STATUS code
*
* DESCRIPTION: Take the linked list resource structure and fills in the
* the appropriate bytes in a byte stream
*
******************************************************************************/
ACPI_STATUS
acpi_rs_address16_stream (
RESOURCE *linked_list,
u8 **output_buffer,
u32 *bytes_consumed)
{
u8 *buffer = *output_buffer;
u8 *length_field;
u8 temp8;
NATIVE_CHAR *temp_pointer = NULL;
u32 actual_bytes;
/*
* The descriptor field is static
*/
*buffer = 0x88;
buffer += 1;
/*
* Save a pointer to the Length field - to be filled in later
*/
length_field = buffer;
buffer += 2;
/*
* Set the Resource Type (Memory, Io, Bus_number)
*/
temp8 = (u8) (linked_list->data.address16.resource_type & 0x03);
*buffer = temp8;
buffer += 1;
/*
* Set the general flags
*/
temp8 = (u8) (linked_list->data.address16.producer_consumer & 0x01);
temp8 |= (linked_list->data.address16.decode & 0x01) << 1;
temp8 |= (linked_list->data.address16.min_address_fixed & 0x01) << 2;
temp8 |= (linked_list->data.address16.max_address_fixed & 0x01) << 3;
*buffer = temp8;
buffer += 1;
/*
* Set the type specific flags
*/
temp8 = 0;
if (MEMORY_RANGE == linked_list->data.address16.resource_type) {
temp8 = (u8)
(linked_list->data.address16.attribute.memory.read_write_attribute &
0x01);
temp8 |=
(linked_list->data.address16.attribute.memory.cache_attribute &
0x0F) << 1;
}
else if (IO_RANGE == linked_list->data.address16.resource_type) {
temp8 = (u8)
(linked_list->data.address16.attribute.io.range_attribute &
0x03);
}
*buffer = temp8;
buffer += 1;
/*
* Set the address space granularity
*/
MOVE_UNALIGNED16_TO_16 (buffer,
&linked_list->data.address16.granularity);
buffer += 2;
/*
* Set the address range minimum
*/
MOVE_UNALIGNED16_TO_16 (buffer,
&linked_list->data.address16.min_address_range);
buffer += 2;
/*
* Set the address range maximum
*/
MOVE_UNALIGNED16_TO_16 (buffer,
&linked_list->data.address16.max_address_range);
buffer += 2;
/*
* Set the address translation offset
*/
MOVE_UNALIGNED16_TO_16 (buffer,
&linked_list->data.address16.address_translation_offset);
buffer += 2;
/*
* Set the address length
*/
MOVE_UNALIGNED16_TO_16 (buffer,
&linked_list->data.address16.address_length);
buffer += 2;
/*
* Resource Source Index and Resource Source are optional
*/
if (0 != linked_list->data.address16.resource_source_string_length) {
temp8 = (u8) linked_list->data.address16.resource_source_index;
*buffer = temp8;
buffer += 1;
temp_pointer = (NATIVE_CHAR *) buffer;
/*
* Copy the string
*/
STRCPY (temp_pointer, linked_list->data.address16.resource_source);
/*
* Buffer needs to be set to the length of the sting + one for the
* terminating null
*/
buffer += (STRLEN (linked_list->data.address16.resource_source) + 1);
}
/*
* Return the number of bytes consumed in this operation
*/
actual_bytes = (u32) ((NATIVE_UINT) buffer -
(NATIVE_UINT) *output_buffer);
*bytes_consumed = actual_bytes;
/*
* Set the length field to the number of bytes consumed
* minus the header size (3 bytes)
*/
actual_bytes -= 3;
MOVE_UNALIGNED16_TO_16 (length_field, &actual_bytes);
return (AE_OK);
}
/*******************************************************************************
*
* FUNCTION: Acpi_rs_address32_resource
*
* PARAMETERS: Byte_stream_buffer - Pointer to the resource input byte
* stream
* Bytes_consumed - u32 pointer that is filled with
* the number of bytes consumed from
* the Byte_stream_buffer
* Output_buffer - Pointer to the user's return buffer
* Structure_size - u32 pointer that is filled with
* the number of bytes in the filled
* in structure
*
* RETURN: Status AE_OK if okay, else a valid ACPI_STATUS code
*
* DESCRIPTION: Take the resource byte stream and fill out the appropriate
* structure pointed to by the Output_buffer. Return the
* number of bytes consumed from the byte stream.
*
******************************************************************************/
ACPI_STATUS
acpi_rs_address32_resource (
u8 *byte_stream_buffer,
u32 *bytes_consumed,
u8 **output_buffer,
u32 *structure_size)
{
u8 *buffer;
RESOURCE *output_struct;
u16 temp16;
u8 temp8;
u32 struct_size;
u32 index;
buffer = byte_stream_buffer;
output_struct = (RESOURCE *) *output_buffer;
struct_size = sizeof (ADDRESS32_RESOURCE) +
RESOURCE_LENGTH_NO_DATA;
/*
* Point past the Descriptor to get the number of bytes consumed
*/
buffer += 1;
MOVE_UNALIGNED16_TO_16 (&temp16, buffer);
*bytes_consumed = temp16 + 3;
output_struct->id = address32;
/*
* Get the Resource Type (Byte3)
*/
buffer += 2;
temp8 = *buffer;
/* Values 0-2 are valid */
if(temp8 > 2) {
return (AE_AML_ERROR);
}
output_struct->data.address32.resource_type = temp8 & 0x03;
/*
* Get the General Flags (Byte4)
*/
buffer += 1;
temp8 = *buffer;
/*
* Producer / Consumer
*/
output_struct->data.address32.producer_consumer = temp8 & 0x01;
/*
* Decode
*/
output_struct->data.address32.decode = (temp8 >> 1) & 0x01;
/*
* Min Address Fixed
*/
output_struct->data.address32.min_address_fixed = (temp8 >> 2) & 0x01;
/*
* Max Address Fixed
*/
output_struct->data.address32.max_address_fixed = (temp8 >> 3) & 0x01;
/*
* Get the Type Specific Flags (Byte5)
*/
buffer += 1;
temp8 = *buffer;
if (MEMORY_RANGE == output_struct->data.address32.resource_type) {
output_struct->data.address32.attribute.memory.read_write_attribute =
(u16) (temp8 & 0x01);
output_struct->data.address32.attribute.memory.cache_attribute =
(u16) ((temp8 >> 1) & 0x0F);
}
else {
if (IO_RANGE == output_struct->data.address32.resource_type) {
output_struct->data.address32.attribute.io.range_attribute =
(u16) (temp8 & 0x03);
}
else {
/* BUS_NUMBER_RANGE == Output_struct->Data.Address32.Resource_type */
/* Nothing needs to be filled in */
}
}
/*
* Get Granularity (Bytes 6-9)
*/
buffer += 1;
MOVE_UNALIGNED32_TO_32 (&output_struct->data.address32.granularity,
buffer);
/*
* Get Min_address_range (Bytes 10-13)
*/
buffer += 4;
MOVE_UNALIGNED32_TO_32 (&output_struct->data.address32.min_address_range,
buffer);
/*
* Get Max_address_range (Bytes 14-17)
*/
buffer += 4;
MOVE_UNALIGNED32_TO_32 (&output_struct->data.address32.max_address_range,
buffer);
/*
* Get Address_translation_offset (Bytes 18-21)
*/
buffer += 4;
MOVE_UNALIGNED32_TO_32
(&output_struct->data.address32.address_translation_offset,
buffer);
/*
* Get Address_length (Bytes 22-25)
*/
buffer += 4;
MOVE_UNALIGNED32_TO_32 (&output_struct->data.address32.address_length,
buffer);
/*
* Resource Source Index (if present)
*/
buffer += 4;
/*
* This will leave us pointing to the Resource Source Index
* If it is present, then save it off and calculate the
* pointer to where the null terminated string goes:
* Each Interrupt takes 32-bits + the 5 bytes of the
* stream that are default.
*/
if (*bytes_consumed > 26) {
/* Dereference the Index */
temp8 = *buffer;
output_struct->data.address32.resource_source_index = (u32)temp8;
/* Point to the String */
buffer += 1;
/* Copy the string into the buffer */
index = 0;
while (0x00 != *buffer) {
output_struct->data.address32.resource_source[index] = *buffer;
buffer += 1;
index += 1;
}
/*
* Add the terminating null
*/
output_struct->data.address32.resource_source[index] = 0x00;
output_struct->data.address32.resource_source_string_length = index + 1;
/*
* In order for the Struct_size to fall on a 32-bit boundry,
* calculate the length of the string and expand the
* Struct_size to the next 32-bit boundry.
*/
temp8 = (u8) (index + 1);
struct_size += ROUND_UP_TO_32_bITS (temp8);
}
else {
output_struct->data.address32.resource_source_index = 0x00;
output_struct->data.address32.resource_source_string_length = 0;
output_struct->data.address32.resource_source[0] = 0x00;
}
/*
* Set the Length parameter
*/
output_struct->length = struct_size;
/*
* Return the final size of the structure
*/
*structure_size = struct_size;
return (AE_OK);
}
/*******************************************************************************
*
* FUNCTION: Acpi_rs_address32_stream
*
* PARAMETERS: Linked_list - Pointer to the resource linked list
* Output_buffer - Pointer to the user's return buffer
* Bytes_consumed - u32 pointer that is filled with
* the number of bytes of the
* Output_buffer used
*
* RETURN: Status AE_OK if okay, else a valid ACPI_STATUS code
*
* DESCRIPTION: Take the linked list resource structure and fills in the
* the appropriate bytes in a byte stream
*
******************************************************************************/
ACPI_STATUS
acpi_rs_address32_stream (
RESOURCE *linked_list,
u8 **output_buffer,
u32 *bytes_consumed)
{
u8 *buffer;
u16 *length_field;
u8 temp8;
NATIVE_CHAR *temp_pointer;
buffer = *output_buffer;
/*
* The descriptor field is static
*/
*buffer = 0x87;
buffer += 1;
/*
* Set a pointer to the Length field - to be filled in later
*/
length_field = (u16 *)buffer;
buffer += 2;
/*
* Set the Resource Type (Memory, Io, Bus_number)
*/
temp8 = (u8) (linked_list->data.address32.resource_type & 0x03);
*buffer = temp8;
buffer += 1;
/*
* Set the general flags
*/
temp8 = (u8) (linked_list->data.address32.producer_consumer & 0x01);
temp8 |= (linked_list->data.address32.decode & 0x01) << 1;
temp8 |= (linked_list->data.address32.min_address_fixed & 0x01) << 2;
temp8 |= (linked_list->data.address32.max_address_fixed & 0x01) << 3;
*buffer = temp8;
buffer += 1;
/*
* Set the type specific flags
*/
temp8 = 0;
if(MEMORY_RANGE == linked_list->data.address32.resource_type) {
temp8 = (u8)
(linked_list->data.address32.attribute.memory.read_write_attribute &
0x01);
temp8 |=
(linked_list->data.address32.attribute.memory.cache_attribute &
0x0F) << 1;
}
else if (IO_RANGE == linked_list->data.address32.resource_type) {
temp8 = (u8)
(linked_list->data.address32.attribute.io.range_attribute &
0x03);
}
*buffer = temp8;
buffer += 1;
/*
* Set the address space granularity
*/
MOVE_UNALIGNED32_TO_32 (buffer,
&linked_list->data.address32.granularity);
buffer += 4;
/*
* Set the address range minimum
*/
MOVE_UNALIGNED32_TO_32 (buffer,
&linked_list->data.address32.min_address_range);
buffer += 4;
/*
* Set the address range maximum
*/
MOVE_UNALIGNED32_TO_32 (buffer,
&linked_list->data.address32.max_address_range);
buffer += 4;
/*
* Set the address translation offset
*/
MOVE_UNALIGNED32_TO_32 (buffer,
&linked_list->data.address32.address_translation_offset);
buffer += 4;
/*
* Set the address length
*/
MOVE_UNALIGNED32_TO_32 (buffer,
&linked_list->data.address32.address_length);
buffer += 4;
/*
* Resource Source Index and Resource Source are optional
*/
if (0 != linked_list->data.address32.resource_source_string_length) {
temp8 = (u8) linked_list->data.address32.resource_source_index;
*buffer = temp8;
buffer += 1;
temp_pointer = (NATIVE_CHAR *) buffer;
/*
* Copy the string
*/
STRCPY (temp_pointer, linked_list->data.address32.resource_source);
/*
* Buffer needs to be set to the length of the sting + one for the
* terminating null
*/
buffer += (STRLEN (linked_list->data.address32.resource_source) + 1);
}
/*
* Return the number of bytes consumed in this operation
*/
*bytes_consumed = (u32) ((NATIVE_UINT) buffer -
(NATIVE_UINT) *output_buffer);
/*
* Set the length field to the number of bytes consumed
* minus the header size (3 bytes)
*/
*length_field = (u16) (*bytes_consumed - 3);
return (AE_OK);
}
Reference in a new issue View git blame Copy permalink