forked from Minki/linux
a0d468718b
Simplify the main loop in acpi_ev_initialize_gpe_block() by rearranging code and removing the "enabled" label that is not necessary any more. Signed-off-by: Rafael J. Wysocki <rjw@sisk.pl> Signed-off-by: Len Brown <len.brown@intel.com>
509 lines
15 KiB
C
509 lines
15 KiB
C
/******************************************************************************
|
|
*
|
|
* Module Name: evgpeblk - GPE block creation and initialization.
|
|
*
|
|
*****************************************************************************/
|
|
|
|
/*
|
|
* Copyright (C) 2000 - 2010, Intel Corp.
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions
|
|
* are met:
|
|
* 1. Redistributions of source code must retain the above copyright
|
|
* notice, this list of conditions, and the following disclaimer,
|
|
* without modification.
|
|
* 2. Redistributions in binary form must reproduce at minimum a disclaimer
|
|
* substantially similar to the "NO WARRANTY" disclaimer below
|
|
* ("Disclaimer") and any redistribution must be conditioned upon
|
|
* including a substantially similar Disclaimer requirement for further
|
|
* binary redistribution.
|
|
* 3. Neither the names of the above-listed copyright holders nor the names
|
|
* of any contributors may be used to endorse or promote products derived
|
|
* from this software without specific prior written permission.
|
|
*
|
|
* Alternatively, this software may be distributed under the terms of the
|
|
* GNU General Public License ("GPL") version 2 as published by the Free
|
|
* Software Foundation.
|
|
*
|
|
* NO WARRANTY
|
|
* THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
|
|
* "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
|
|
* LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTIBILITY AND FITNESS FOR
|
|
* A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT
|
|
* HOLDERS OR CONTRIBUTORS BE LIABLE FOR SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
|
|
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
|
|
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
|
|
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
|
|
* STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING
|
|
* IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
|
* POSSIBILITY OF SUCH DAMAGES.
|
|
*/
|
|
|
|
#include <acpi/acpi.h>
|
|
#include "accommon.h"
|
|
#include "acevents.h"
|
|
#include "acnamesp.h"
|
|
|
|
#define _COMPONENT ACPI_EVENTS
|
|
ACPI_MODULE_NAME("evgpeblk")
|
|
|
|
/* Local prototypes */
|
|
static acpi_status
|
|
acpi_ev_install_gpe_block(struct acpi_gpe_block_info *gpe_block,
|
|
u32 interrupt_number);
|
|
|
|
static acpi_status
|
|
acpi_ev_create_gpe_info_blocks(struct acpi_gpe_block_info *gpe_block);
|
|
|
|
/*******************************************************************************
|
|
*
|
|
* FUNCTION: acpi_ev_install_gpe_block
|
|
*
|
|
* PARAMETERS: gpe_block - New GPE block
|
|
* interrupt_number - Xrupt to be associated with this
|
|
* GPE block
|
|
*
|
|
* RETURN: Status
|
|
*
|
|
* DESCRIPTION: Install new GPE block with mutex support
|
|
*
|
|
******************************************************************************/
|
|
|
|
static acpi_status
|
|
acpi_ev_install_gpe_block(struct acpi_gpe_block_info *gpe_block,
|
|
u32 interrupt_number)
|
|
{
|
|
struct acpi_gpe_block_info *next_gpe_block;
|
|
struct acpi_gpe_xrupt_info *gpe_xrupt_block;
|
|
acpi_status status;
|
|
acpi_cpu_flags flags;
|
|
|
|
ACPI_FUNCTION_TRACE(ev_install_gpe_block);
|
|
|
|
status = acpi_ut_acquire_mutex(ACPI_MTX_EVENTS);
|
|
if (ACPI_FAILURE(status)) {
|
|
return_ACPI_STATUS(status);
|
|
}
|
|
|
|
gpe_xrupt_block = acpi_ev_get_gpe_xrupt_block(interrupt_number);
|
|
if (!gpe_xrupt_block) {
|
|
status = AE_NO_MEMORY;
|
|
goto unlock_and_exit;
|
|
}
|
|
|
|
/* Install the new block at the end of the list with lock */
|
|
|
|
flags = acpi_os_acquire_lock(acpi_gbl_gpe_lock);
|
|
if (gpe_xrupt_block->gpe_block_list_head) {
|
|
next_gpe_block = gpe_xrupt_block->gpe_block_list_head;
|
|
while (next_gpe_block->next) {
|
|
next_gpe_block = next_gpe_block->next;
|
|
}
|
|
|
|
next_gpe_block->next = gpe_block;
|
|
gpe_block->previous = next_gpe_block;
|
|
} else {
|
|
gpe_xrupt_block->gpe_block_list_head = gpe_block;
|
|
}
|
|
|
|
gpe_block->xrupt_block = gpe_xrupt_block;
|
|
acpi_os_release_lock(acpi_gbl_gpe_lock, flags);
|
|
|
|
unlock_and_exit:
|
|
status = acpi_ut_release_mutex(ACPI_MTX_EVENTS);
|
|
return_ACPI_STATUS(status);
|
|
}
|
|
|
|
/*******************************************************************************
|
|
*
|
|
* FUNCTION: acpi_ev_delete_gpe_block
|
|
*
|
|
* PARAMETERS: gpe_block - Existing GPE block
|
|
*
|
|
* RETURN: Status
|
|
*
|
|
* DESCRIPTION: Remove a GPE block
|
|
*
|
|
******************************************************************************/
|
|
|
|
acpi_status acpi_ev_delete_gpe_block(struct acpi_gpe_block_info *gpe_block)
|
|
{
|
|
acpi_status status;
|
|
acpi_cpu_flags flags;
|
|
|
|
ACPI_FUNCTION_TRACE(ev_install_gpe_block);
|
|
|
|
status = acpi_ut_acquire_mutex(ACPI_MTX_EVENTS);
|
|
if (ACPI_FAILURE(status)) {
|
|
return_ACPI_STATUS(status);
|
|
}
|
|
|
|
/* Disable all GPEs in this block */
|
|
|
|
status =
|
|
acpi_hw_disable_gpe_block(gpe_block->xrupt_block, gpe_block, NULL);
|
|
|
|
if (!gpe_block->previous && !gpe_block->next) {
|
|
|
|
/* This is the last gpe_block on this interrupt */
|
|
|
|
status = acpi_ev_delete_gpe_xrupt(gpe_block->xrupt_block);
|
|
if (ACPI_FAILURE(status)) {
|
|
goto unlock_and_exit;
|
|
}
|
|
} else {
|
|
/* Remove the block on this interrupt with lock */
|
|
|
|
flags = acpi_os_acquire_lock(acpi_gbl_gpe_lock);
|
|
if (gpe_block->previous) {
|
|
gpe_block->previous->next = gpe_block->next;
|
|
} else {
|
|
gpe_block->xrupt_block->gpe_block_list_head =
|
|
gpe_block->next;
|
|
}
|
|
|
|
if (gpe_block->next) {
|
|
gpe_block->next->previous = gpe_block->previous;
|
|
}
|
|
acpi_os_release_lock(acpi_gbl_gpe_lock, flags);
|
|
}
|
|
|
|
acpi_current_gpe_count -= gpe_block->gpe_count;
|
|
|
|
/* Free the gpe_block */
|
|
|
|
ACPI_FREE(gpe_block->register_info);
|
|
ACPI_FREE(gpe_block->event_info);
|
|
ACPI_FREE(gpe_block);
|
|
|
|
unlock_and_exit:
|
|
status = acpi_ut_release_mutex(ACPI_MTX_EVENTS);
|
|
return_ACPI_STATUS(status);
|
|
}
|
|
|
|
/*******************************************************************************
|
|
*
|
|
* FUNCTION: acpi_ev_create_gpe_info_blocks
|
|
*
|
|
* PARAMETERS: gpe_block - New GPE block
|
|
*
|
|
* RETURN: Status
|
|
*
|
|
* DESCRIPTION: Create the register_info and event_info blocks for this GPE block
|
|
*
|
|
******************************************************************************/
|
|
|
|
static acpi_status
|
|
acpi_ev_create_gpe_info_blocks(struct acpi_gpe_block_info *gpe_block)
|
|
{
|
|
struct acpi_gpe_register_info *gpe_register_info = NULL;
|
|
struct acpi_gpe_event_info *gpe_event_info = NULL;
|
|
struct acpi_gpe_event_info *this_event;
|
|
struct acpi_gpe_register_info *this_register;
|
|
u32 i;
|
|
u32 j;
|
|
acpi_status status;
|
|
|
|
ACPI_FUNCTION_TRACE(ev_create_gpe_info_blocks);
|
|
|
|
/* Allocate the GPE register information block */
|
|
|
|
gpe_register_info = ACPI_ALLOCATE_ZEROED((acpi_size) gpe_block->
|
|
register_count *
|
|
sizeof(struct
|
|
acpi_gpe_register_info));
|
|
if (!gpe_register_info) {
|
|
ACPI_ERROR((AE_INFO,
|
|
"Could not allocate the GpeRegisterInfo table"));
|
|
return_ACPI_STATUS(AE_NO_MEMORY);
|
|
}
|
|
|
|
/*
|
|
* Allocate the GPE event_info block. There are eight distinct GPEs
|
|
* per register. Initialization to zeros is sufficient.
|
|
*/
|
|
gpe_event_info = ACPI_ALLOCATE_ZEROED((acpi_size) gpe_block->gpe_count *
|
|
sizeof(struct
|
|
acpi_gpe_event_info));
|
|
if (!gpe_event_info) {
|
|
ACPI_ERROR((AE_INFO,
|
|
"Could not allocate the GpeEventInfo table"));
|
|
status = AE_NO_MEMORY;
|
|
goto error_exit;
|
|
}
|
|
|
|
/* Save the new Info arrays in the GPE block */
|
|
|
|
gpe_block->register_info = gpe_register_info;
|
|
gpe_block->event_info = gpe_event_info;
|
|
|
|
/*
|
|
* Initialize the GPE Register and Event structures. A goal of these
|
|
* tables is to hide the fact that there are two separate GPE register
|
|
* sets in a given GPE hardware block, the status registers occupy the
|
|
* first half, and the enable registers occupy the second half.
|
|
*/
|
|
this_register = gpe_register_info;
|
|
this_event = gpe_event_info;
|
|
|
|
for (i = 0; i < gpe_block->register_count; i++) {
|
|
|
|
/* Init the register_info for this GPE register (8 GPEs) */
|
|
|
|
this_register->base_gpe_number =
|
|
(u8) (gpe_block->block_base_number +
|
|
(i * ACPI_GPE_REGISTER_WIDTH));
|
|
|
|
this_register->status_address.address =
|
|
gpe_block->block_address.address + i;
|
|
|
|
this_register->enable_address.address =
|
|
gpe_block->block_address.address + i +
|
|
gpe_block->register_count;
|
|
|
|
this_register->status_address.space_id =
|
|
gpe_block->block_address.space_id;
|
|
this_register->enable_address.space_id =
|
|
gpe_block->block_address.space_id;
|
|
this_register->status_address.bit_width =
|
|
ACPI_GPE_REGISTER_WIDTH;
|
|
this_register->enable_address.bit_width =
|
|
ACPI_GPE_REGISTER_WIDTH;
|
|
this_register->status_address.bit_offset = 0;
|
|
this_register->enable_address.bit_offset = 0;
|
|
|
|
/* Init the event_info for each GPE within this register */
|
|
|
|
for (j = 0; j < ACPI_GPE_REGISTER_WIDTH; j++) {
|
|
this_event->gpe_number =
|
|
(u8) (this_register->base_gpe_number + j);
|
|
this_event->register_info = this_register;
|
|
this_event++;
|
|
}
|
|
|
|
/* Disable all GPEs within this register */
|
|
|
|
status = acpi_hw_write(0x00, &this_register->enable_address);
|
|
if (ACPI_FAILURE(status)) {
|
|
goto error_exit;
|
|
}
|
|
|
|
/* Clear any pending GPE events within this register */
|
|
|
|
status = acpi_hw_write(0xFF, &this_register->status_address);
|
|
if (ACPI_FAILURE(status)) {
|
|
goto error_exit;
|
|
}
|
|
|
|
this_register++;
|
|
}
|
|
|
|
return_ACPI_STATUS(AE_OK);
|
|
|
|
error_exit:
|
|
if (gpe_register_info) {
|
|
ACPI_FREE(gpe_register_info);
|
|
}
|
|
if (gpe_event_info) {
|
|
ACPI_FREE(gpe_event_info);
|
|
}
|
|
|
|
return_ACPI_STATUS(status);
|
|
}
|
|
|
|
/*******************************************************************************
|
|
*
|
|
* FUNCTION: acpi_ev_create_gpe_block
|
|
*
|
|
* PARAMETERS: gpe_device - Handle to the parent GPE block
|
|
* gpe_block_address - Address and space_iD
|
|
* register_count - Number of GPE register pairs in the block
|
|
* gpe_block_base_number - Starting GPE number for the block
|
|
* interrupt_number - H/W interrupt for the block
|
|
* return_gpe_block - Where the new block descriptor is returned
|
|
*
|
|
* RETURN: Status
|
|
*
|
|
* DESCRIPTION: Create and Install a block of GPE registers. All GPEs within
|
|
* the block are disabled at exit.
|
|
* Note: Assumes namespace is locked.
|
|
*
|
|
******************************************************************************/
|
|
|
|
acpi_status
|
|
acpi_ev_create_gpe_block(struct acpi_namespace_node *gpe_device,
|
|
struct acpi_generic_address *gpe_block_address,
|
|
u32 register_count,
|
|
u8 gpe_block_base_number,
|
|
u32 interrupt_number,
|
|
struct acpi_gpe_block_info **return_gpe_block)
|
|
{
|
|
acpi_status status;
|
|
struct acpi_gpe_block_info *gpe_block;
|
|
struct acpi_gpe_walk_info walk_info;
|
|
|
|
ACPI_FUNCTION_TRACE(ev_create_gpe_block);
|
|
|
|
if (!register_count) {
|
|
return_ACPI_STATUS(AE_OK);
|
|
}
|
|
|
|
/* Allocate a new GPE block */
|
|
|
|
gpe_block = ACPI_ALLOCATE_ZEROED(sizeof(struct acpi_gpe_block_info));
|
|
if (!gpe_block) {
|
|
return_ACPI_STATUS(AE_NO_MEMORY);
|
|
}
|
|
|
|
/* Initialize the new GPE block */
|
|
|
|
gpe_block->node = gpe_device;
|
|
gpe_block->gpe_count = (u16)(register_count * ACPI_GPE_REGISTER_WIDTH);
|
|
gpe_block->register_count = register_count;
|
|
gpe_block->block_base_number = gpe_block_base_number;
|
|
|
|
ACPI_MEMCPY(&gpe_block->block_address, gpe_block_address,
|
|
sizeof(struct acpi_generic_address));
|
|
|
|
/*
|
|
* Create the register_info and event_info sub-structures
|
|
* Note: disables and clears all GPEs in the block
|
|
*/
|
|
status = acpi_ev_create_gpe_info_blocks(gpe_block);
|
|
if (ACPI_FAILURE(status)) {
|
|
ACPI_FREE(gpe_block);
|
|
return_ACPI_STATUS(status);
|
|
}
|
|
|
|
/* Install the new block in the global lists */
|
|
|
|
status = acpi_ev_install_gpe_block(gpe_block, interrupt_number);
|
|
if (ACPI_FAILURE(status)) {
|
|
ACPI_FREE(gpe_block);
|
|
return_ACPI_STATUS(status);
|
|
}
|
|
|
|
/* Find all GPE methods (_Lxx or_Exx) for this block */
|
|
|
|
walk_info.gpe_block = gpe_block;
|
|
walk_info.gpe_device = gpe_device;
|
|
walk_info.enable_this_gpe = FALSE;
|
|
walk_info.execute_by_owner_id = FALSE;
|
|
|
|
status = acpi_ns_walk_namespace(ACPI_TYPE_METHOD, gpe_device,
|
|
ACPI_UINT32_MAX, ACPI_NS_WALK_NO_UNLOCK,
|
|
acpi_ev_match_gpe_method, NULL,
|
|
&walk_info, NULL);
|
|
|
|
/* Return the new block */
|
|
|
|
if (return_gpe_block) {
|
|
(*return_gpe_block) = gpe_block;
|
|
}
|
|
|
|
ACPI_DEBUG_PRINT((ACPI_DB_INIT,
|
|
"GPE %02X to %02X [%4.4s] %u regs on int 0x%X\n",
|
|
(u32) gpe_block->block_base_number,
|
|
(u32) (gpe_block->block_base_number +
|
|
(gpe_block->gpe_count - 1)),
|
|
gpe_device->name.ascii, gpe_block->register_count,
|
|
interrupt_number));
|
|
|
|
/* Update global count of currently available GPEs */
|
|
|
|
acpi_current_gpe_count += gpe_block->gpe_count;
|
|
return_ACPI_STATUS(AE_OK);
|
|
}
|
|
|
|
/*******************************************************************************
|
|
*
|
|
* FUNCTION: acpi_ev_initialize_gpe_block
|
|
*
|
|
* PARAMETERS: gpe_device - Handle to the parent GPE block
|
|
* gpe_block - Gpe Block info
|
|
*
|
|
* RETURN: Status
|
|
*
|
|
* DESCRIPTION: Initialize and enable a GPE block. First find and run any
|
|
* _PRT methods associated with the block, then enable the
|
|
* appropriate GPEs.
|
|
* Note: Assumes namespace is locked.
|
|
*
|
|
******************************************************************************/
|
|
|
|
acpi_status
|
|
acpi_ev_initialize_gpe_block(struct acpi_namespace_node *gpe_device,
|
|
struct acpi_gpe_block_info *gpe_block)
|
|
{
|
|
acpi_status status;
|
|
struct acpi_gpe_event_info *gpe_event_info;
|
|
u32 gpe_enabled_count;
|
|
u32 gpe_index;
|
|
u32 gpe_number;
|
|
u32 i;
|
|
u32 j;
|
|
|
|
ACPI_FUNCTION_TRACE(ev_initialize_gpe_block);
|
|
|
|
/* Ignore a null GPE block (e.g., if no GPE block 1 exists) */
|
|
|
|
if (!gpe_block) {
|
|
return_ACPI_STATUS(AE_OK);
|
|
}
|
|
|
|
/*
|
|
* Enable all GPEs that have a corresponding method. Any other GPEs
|
|
* within this block must be enabled via the acpi_enable_gpe interface.
|
|
*/
|
|
gpe_enabled_count = 0;
|
|
|
|
if (gpe_device == acpi_gbl_fadt_gpe_device) {
|
|
gpe_device = NULL;
|
|
}
|
|
|
|
for (i = 0; i < gpe_block->register_count; i++) {
|
|
for (j = 0; j < ACPI_GPE_REGISTER_WIDTH; j++) {
|
|
|
|
/* Get the info block for this particular GPE */
|
|
|
|
gpe_index = (i * ACPI_GPE_REGISTER_WIDTH) + j;
|
|
gpe_event_info = &gpe_block->event_info[gpe_index];
|
|
gpe_number = gpe_index + gpe_block->block_base_number;
|
|
|
|
/* Ignore GPEs that have no corresponding _Lxx/_Exx method */
|
|
|
|
if (!(gpe_event_info->flags & ACPI_GPE_DISPATCH_METHOD)) {
|
|
continue;
|
|
}
|
|
|
|
/*
|
|
* If the GPE has already been enabled for runtime
|
|
* signaling, make sure it remains enabled, but do not
|
|
* increment its reference counter.
|
|
*/
|
|
status = gpe_event_info->runtime_count ?
|
|
acpi_ev_enable_gpe(gpe_event_info) :
|
|
acpi_enable_gpe(gpe_device, gpe_number);
|
|
|
|
if (ACPI_FAILURE(status)) {
|
|
ACPI_EXCEPTION((AE_INFO, status,
|
|
"Could not enable GPE 0x%02X",
|
|
gpe_number));
|
|
continue;
|
|
}
|
|
|
|
gpe_enabled_count++;
|
|
}
|
|
}
|
|
|
|
if (gpe_enabled_count) {
|
|
ACPI_DEBUG_PRINT((ACPI_DB_INIT,
|
|
"Enabled %u GPEs in this block\n",
|
|
gpe_enabled_count));
|
|
}
|
|
|
|
return_ACPI_STATUS(AE_OK);
|
|
}
|