mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-05 18:14:07 +08:00
752cad760b
There is no need to initialize the node before appending it to the list. Signed-off-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com> Reviewed-by: Mika Westerberg <mika.westerberg@linux.intel.com> Signed-off-by: Rafael J. Wysocki <rafael.j.wysocki@intel.com>
527 lines
15 KiB
C
527 lines
15 KiB
C
/*
|
|
* drivers/acpi/resource.c - ACPI device resources interpretation.
|
|
*
|
|
* Copyright (C) 2012, Intel Corp.
|
|
* Author: Rafael J. Wysocki <rafael.j.wysocki@intel.com>
|
|
*
|
|
* ~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
|
|
*
|
|
* This program is free software; you can redistribute it and/or modify
|
|
* it under the terms of the GNU General Public License version 2 as published
|
|
* by the Free Software Foundation.
|
|
*
|
|
* 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 <linux/acpi.h>
|
|
#include <linux/device.h>
|
|
#include <linux/export.h>
|
|
#include <linux/ioport.h>
|
|
#include <linux/slab.h>
|
|
|
|
#ifdef CONFIG_X86
|
|
#define valid_IRQ(i) (((i) != 0) && ((i) != 2))
|
|
#else
|
|
#define valid_IRQ(i) (true)
|
|
#endif
|
|
|
|
static unsigned long acpi_dev_memresource_flags(u64 len, u8 write_protect,
|
|
bool window)
|
|
{
|
|
unsigned long flags = IORESOURCE_MEM;
|
|
|
|
if (len == 0)
|
|
flags |= IORESOURCE_DISABLED;
|
|
|
|
if (write_protect == ACPI_READ_WRITE_MEMORY)
|
|
flags |= IORESOURCE_MEM_WRITEABLE;
|
|
|
|
if (window)
|
|
flags |= IORESOURCE_WINDOW;
|
|
|
|
return flags;
|
|
}
|
|
|
|
static void acpi_dev_get_memresource(struct resource *res, u64 start, u64 len,
|
|
u8 write_protect)
|
|
{
|
|
res->start = start;
|
|
res->end = start + len - 1;
|
|
res->flags = acpi_dev_memresource_flags(len, write_protect, false);
|
|
}
|
|
|
|
/**
|
|
* acpi_dev_resource_memory - Extract ACPI memory resource information.
|
|
* @ares: Input ACPI resource object.
|
|
* @res: Output generic resource object.
|
|
*
|
|
* Check if the given ACPI resource object represents a memory resource and
|
|
* if that's the case, use the information in it to populate the generic
|
|
* resource object pointed to by @res.
|
|
*/
|
|
bool acpi_dev_resource_memory(struct acpi_resource *ares, struct resource *res)
|
|
{
|
|
struct acpi_resource_memory24 *memory24;
|
|
struct acpi_resource_memory32 *memory32;
|
|
struct acpi_resource_fixed_memory32 *fixed_memory32;
|
|
|
|
switch (ares->type) {
|
|
case ACPI_RESOURCE_TYPE_MEMORY24:
|
|
memory24 = &ares->data.memory24;
|
|
acpi_dev_get_memresource(res, memory24->minimum,
|
|
memory24->address_length,
|
|
memory24->write_protect);
|
|
break;
|
|
case ACPI_RESOURCE_TYPE_MEMORY32:
|
|
memory32 = &ares->data.memory32;
|
|
acpi_dev_get_memresource(res, memory32->minimum,
|
|
memory32->address_length,
|
|
memory32->write_protect);
|
|
break;
|
|
case ACPI_RESOURCE_TYPE_FIXED_MEMORY32:
|
|
fixed_memory32 = &ares->data.fixed_memory32;
|
|
acpi_dev_get_memresource(res, fixed_memory32->address,
|
|
fixed_memory32->address_length,
|
|
fixed_memory32->write_protect);
|
|
break;
|
|
default:
|
|
return false;
|
|
}
|
|
return true;
|
|
}
|
|
EXPORT_SYMBOL_GPL(acpi_dev_resource_memory);
|
|
|
|
static unsigned int acpi_dev_ioresource_flags(u64 start, u64 end, u8 io_decode,
|
|
bool window)
|
|
{
|
|
int flags = IORESOURCE_IO;
|
|
|
|
if (io_decode == ACPI_DECODE_16)
|
|
flags |= IORESOURCE_IO_16BIT_ADDR;
|
|
|
|
if (start > end || end >= 0x10003)
|
|
flags |= IORESOURCE_DISABLED;
|
|
|
|
if (window)
|
|
flags |= IORESOURCE_WINDOW;
|
|
|
|
return flags;
|
|
}
|
|
|
|
static void acpi_dev_get_ioresource(struct resource *res, u64 start, u64 len,
|
|
u8 io_decode)
|
|
{
|
|
u64 end = start + len - 1;
|
|
|
|
res->start = start;
|
|
res->end = end;
|
|
res->flags = acpi_dev_ioresource_flags(start, end, io_decode, false);
|
|
}
|
|
|
|
/**
|
|
* acpi_dev_resource_io - Extract ACPI I/O resource information.
|
|
* @ares: Input ACPI resource object.
|
|
* @res: Output generic resource object.
|
|
*
|
|
* Check if the given ACPI resource object represents an I/O resource and
|
|
* if that's the case, use the information in it to populate the generic
|
|
* resource object pointed to by @res.
|
|
*/
|
|
bool acpi_dev_resource_io(struct acpi_resource *ares, struct resource *res)
|
|
{
|
|
struct acpi_resource_io *io;
|
|
struct acpi_resource_fixed_io *fixed_io;
|
|
|
|
switch (ares->type) {
|
|
case ACPI_RESOURCE_TYPE_IO:
|
|
io = &ares->data.io;
|
|
acpi_dev_get_ioresource(res, io->minimum,
|
|
io->address_length,
|
|
io->io_decode);
|
|
break;
|
|
case ACPI_RESOURCE_TYPE_FIXED_IO:
|
|
fixed_io = &ares->data.fixed_io;
|
|
acpi_dev_get_ioresource(res, fixed_io->address,
|
|
fixed_io->address_length,
|
|
ACPI_DECODE_10);
|
|
break;
|
|
default:
|
|
return false;
|
|
}
|
|
return true;
|
|
}
|
|
EXPORT_SYMBOL_GPL(acpi_dev_resource_io);
|
|
|
|
/**
|
|
* acpi_dev_resource_address_space - Extract ACPI address space information.
|
|
* @ares: Input ACPI resource object.
|
|
* @res: Output generic resource object.
|
|
*
|
|
* Check if the given ACPI resource object represents an address space resource
|
|
* and if that's the case, use the information in it to populate the generic
|
|
* resource object pointed to by @res.
|
|
*/
|
|
bool acpi_dev_resource_address_space(struct acpi_resource *ares,
|
|
struct resource *res)
|
|
{
|
|
acpi_status status;
|
|
struct acpi_resource_address64 addr;
|
|
bool window;
|
|
u64 len;
|
|
u8 io_decode;
|
|
|
|
switch (ares->type) {
|
|
case ACPI_RESOURCE_TYPE_ADDRESS16:
|
|
case ACPI_RESOURCE_TYPE_ADDRESS32:
|
|
case ACPI_RESOURCE_TYPE_ADDRESS64:
|
|
break;
|
|
default:
|
|
return false;
|
|
}
|
|
|
|
status = acpi_resource_to_address64(ares, &addr);
|
|
if (ACPI_FAILURE(status))
|
|
return true;
|
|
|
|
res->start = addr.minimum;
|
|
res->end = addr.maximum;
|
|
window = addr.producer_consumer == ACPI_PRODUCER;
|
|
|
|
switch(addr.resource_type) {
|
|
case ACPI_MEMORY_RANGE:
|
|
len = addr.maximum - addr.minimum + 1;
|
|
res->flags = acpi_dev_memresource_flags(len,
|
|
addr.info.mem.write_protect,
|
|
window);
|
|
break;
|
|
case ACPI_IO_RANGE:
|
|
io_decode = addr.granularity == 0xfff ?
|
|
ACPI_DECODE_10 : ACPI_DECODE_16;
|
|
res->flags = acpi_dev_ioresource_flags(addr.minimum,
|
|
addr.maximum,
|
|
io_decode, window);
|
|
break;
|
|
case ACPI_BUS_NUMBER_RANGE:
|
|
res->flags = IORESOURCE_BUS;
|
|
break;
|
|
default:
|
|
res->flags = 0;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
EXPORT_SYMBOL_GPL(acpi_dev_resource_address_space);
|
|
|
|
/**
|
|
* acpi_dev_resource_ext_address_space - Extract ACPI address space information.
|
|
* @ares: Input ACPI resource object.
|
|
* @res: Output generic resource object.
|
|
*
|
|
* Check if the given ACPI resource object represents an extended address space
|
|
* resource and if that's the case, use the information in it to populate the
|
|
* generic resource object pointed to by @res.
|
|
*/
|
|
bool acpi_dev_resource_ext_address_space(struct acpi_resource *ares,
|
|
struct resource *res)
|
|
{
|
|
struct acpi_resource_extended_address64 *ext_addr;
|
|
bool window;
|
|
u64 len;
|
|
u8 io_decode;
|
|
|
|
if (ares->type != ACPI_RESOURCE_TYPE_EXTENDED_ADDRESS64)
|
|
return false;
|
|
|
|
ext_addr = &ares->data.ext_address64;
|
|
|
|
res->start = ext_addr->minimum;
|
|
res->end = ext_addr->maximum;
|
|
window = ext_addr->producer_consumer == ACPI_PRODUCER;
|
|
|
|
switch(ext_addr->resource_type) {
|
|
case ACPI_MEMORY_RANGE:
|
|
len = ext_addr->maximum - ext_addr->minimum + 1;
|
|
res->flags = acpi_dev_memresource_flags(len,
|
|
ext_addr->info.mem.write_protect,
|
|
window);
|
|
break;
|
|
case ACPI_IO_RANGE:
|
|
io_decode = ext_addr->granularity == 0xfff ?
|
|
ACPI_DECODE_10 : ACPI_DECODE_16;
|
|
res->flags = acpi_dev_ioresource_flags(ext_addr->minimum,
|
|
ext_addr->maximum,
|
|
io_decode, window);
|
|
break;
|
|
case ACPI_BUS_NUMBER_RANGE:
|
|
res->flags = IORESOURCE_BUS;
|
|
break;
|
|
default:
|
|
res->flags = 0;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
EXPORT_SYMBOL_GPL(acpi_dev_resource_ext_address_space);
|
|
|
|
/**
|
|
* acpi_dev_irq_flags - Determine IRQ resource flags.
|
|
* @triggering: Triggering type as provided by ACPI.
|
|
* @polarity: Interrupt polarity as provided by ACPI.
|
|
* @shareable: Whether or not the interrupt is shareable.
|
|
*/
|
|
unsigned long acpi_dev_irq_flags(u8 triggering, u8 polarity, u8 shareable)
|
|
{
|
|
unsigned long flags;
|
|
|
|
if (triggering == ACPI_LEVEL_SENSITIVE)
|
|
flags = polarity == ACPI_ACTIVE_LOW ?
|
|
IORESOURCE_IRQ_LOWLEVEL : IORESOURCE_IRQ_HIGHLEVEL;
|
|
else
|
|
flags = polarity == ACPI_ACTIVE_LOW ?
|
|
IORESOURCE_IRQ_LOWEDGE : IORESOURCE_IRQ_HIGHEDGE;
|
|
|
|
if (shareable == ACPI_SHARED)
|
|
flags |= IORESOURCE_IRQ_SHAREABLE;
|
|
|
|
return flags | IORESOURCE_IRQ;
|
|
}
|
|
EXPORT_SYMBOL_GPL(acpi_dev_irq_flags);
|
|
|
|
static void acpi_dev_irqresource_disabled(struct resource *res, u32 gsi)
|
|
{
|
|
res->start = gsi;
|
|
res->end = gsi;
|
|
res->flags = IORESOURCE_IRQ | IORESOURCE_DISABLED;
|
|
}
|
|
|
|
static void acpi_dev_get_irqresource(struct resource *res, u32 gsi,
|
|
u8 triggering, u8 polarity, u8 shareable)
|
|
{
|
|
int irq, p, t;
|
|
|
|
if (!valid_IRQ(gsi)) {
|
|
acpi_dev_irqresource_disabled(res, gsi);
|
|
return;
|
|
}
|
|
|
|
/*
|
|
* In IO-APIC mode, use overrided attribute. Two reasons:
|
|
* 1. BIOS bug in DSDT
|
|
* 2. BIOS uses IO-APIC mode Interrupt Source Override
|
|
*/
|
|
if (!acpi_get_override_irq(gsi, &t, &p)) {
|
|
u8 trig = t ? ACPI_LEVEL_SENSITIVE : ACPI_EDGE_SENSITIVE;
|
|
u8 pol = p ? ACPI_ACTIVE_LOW : ACPI_ACTIVE_HIGH;
|
|
|
|
if (triggering != trig || polarity != pol) {
|
|
pr_warning("ACPI: IRQ %d override to %s, %s\n", gsi,
|
|
t ? "edge" : "level", p ? "low" : "high");
|
|
triggering = trig;
|
|
polarity = pol;
|
|
}
|
|
}
|
|
|
|
res->flags = acpi_dev_irq_flags(triggering, polarity, shareable);
|
|
irq = acpi_register_gsi(NULL, gsi, triggering, polarity);
|
|
if (irq >= 0) {
|
|
res->start = irq;
|
|
res->end = irq;
|
|
} else {
|
|
acpi_dev_irqresource_disabled(res, gsi);
|
|
}
|
|
}
|
|
|
|
/**
|
|
* acpi_dev_resource_interrupt - Extract ACPI interrupt resource information.
|
|
* @ares: Input ACPI resource object.
|
|
* @index: Index into the array of GSIs represented by the resource.
|
|
* @res: Output generic resource object.
|
|
*
|
|
* Check if the given ACPI resource object represents an interrupt resource
|
|
* and @index does not exceed the resource's interrupt count (true is returned
|
|
* in that case regardless of the results of the other checks)). If that's the
|
|
* case, register the GSI corresponding to @index from the array of interrupts
|
|
* represented by the resource and populate the generic resource object pointed
|
|
* to by @res accordingly. If the registration of the GSI is not successful,
|
|
* IORESOURCE_DISABLED will be set it that object's flags.
|
|
*/
|
|
bool acpi_dev_resource_interrupt(struct acpi_resource *ares, int index,
|
|
struct resource *res)
|
|
{
|
|
struct acpi_resource_irq *irq;
|
|
struct acpi_resource_extended_irq *ext_irq;
|
|
|
|
switch (ares->type) {
|
|
case ACPI_RESOURCE_TYPE_IRQ:
|
|
/*
|
|
* Per spec, only one interrupt per descriptor is allowed in
|
|
* _CRS, but some firmware violates this, so parse them all.
|
|
*/
|
|
irq = &ares->data.irq;
|
|
if (index >= irq->interrupt_count) {
|
|
acpi_dev_irqresource_disabled(res, 0);
|
|
return false;
|
|
}
|
|
acpi_dev_get_irqresource(res, irq->interrupts[index],
|
|
irq->triggering, irq->polarity,
|
|
irq->sharable);
|
|
break;
|
|
case ACPI_RESOURCE_TYPE_EXTENDED_IRQ:
|
|
ext_irq = &ares->data.extended_irq;
|
|
if (index >= ext_irq->interrupt_count) {
|
|
acpi_dev_irqresource_disabled(res, 0);
|
|
return false;
|
|
}
|
|
acpi_dev_get_irqresource(res, ext_irq->interrupts[index],
|
|
ext_irq->triggering, ext_irq->polarity,
|
|
ext_irq->sharable);
|
|
break;
|
|
default:
|
|
return false;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
EXPORT_SYMBOL_GPL(acpi_dev_resource_interrupt);
|
|
|
|
/**
|
|
* acpi_dev_free_resource_list - Free resource from %acpi_dev_get_resources().
|
|
* @list: The head of the resource list to free.
|
|
*/
|
|
void acpi_dev_free_resource_list(struct list_head *list)
|
|
{
|
|
struct resource_list_entry *rentry, *re;
|
|
|
|
list_for_each_entry_safe(rentry, re, list, node) {
|
|
list_del(&rentry->node);
|
|
kfree(rentry);
|
|
}
|
|
}
|
|
EXPORT_SYMBOL_GPL(acpi_dev_free_resource_list);
|
|
|
|
struct res_proc_context {
|
|
struct list_head *list;
|
|
int (*preproc)(struct acpi_resource *, void *);
|
|
void *preproc_data;
|
|
int count;
|
|
int error;
|
|
};
|
|
|
|
static acpi_status acpi_dev_new_resource_entry(struct resource *r,
|
|
struct res_proc_context *c)
|
|
{
|
|
struct resource_list_entry *rentry;
|
|
|
|
rentry = kmalloc(sizeof(*rentry), GFP_KERNEL);
|
|
if (!rentry) {
|
|
c->error = -ENOMEM;
|
|
return AE_NO_MEMORY;
|
|
}
|
|
rentry->res = *r;
|
|
list_add_tail(&rentry->node, c->list);
|
|
c->count++;
|
|
return AE_OK;
|
|
}
|
|
|
|
static acpi_status acpi_dev_process_resource(struct acpi_resource *ares,
|
|
void *context)
|
|
{
|
|
struct res_proc_context *c = context;
|
|
struct resource r;
|
|
int i;
|
|
|
|
if (c->preproc) {
|
|
int ret;
|
|
|
|
ret = c->preproc(ares, c->preproc_data);
|
|
if (ret < 0) {
|
|
c->error = ret;
|
|
return AE_CTRL_TERMINATE;
|
|
} else if (ret > 0) {
|
|
return AE_OK;
|
|
}
|
|
}
|
|
|
|
memset(&r, 0, sizeof(r));
|
|
|
|
if (acpi_dev_resource_memory(ares, &r)
|
|
|| acpi_dev_resource_io(ares, &r)
|
|
|| acpi_dev_resource_address_space(ares, &r)
|
|
|| acpi_dev_resource_ext_address_space(ares, &r))
|
|
return acpi_dev_new_resource_entry(&r, c);
|
|
|
|
for (i = 0; acpi_dev_resource_interrupt(ares, i, &r); i++) {
|
|
acpi_status status;
|
|
|
|
status = acpi_dev_new_resource_entry(&r, c);
|
|
if (ACPI_FAILURE(status))
|
|
return status;
|
|
}
|
|
|
|
return AE_OK;
|
|
}
|
|
|
|
/**
|
|
* acpi_dev_get_resources - Get current resources of a device.
|
|
* @adev: ACPI device node to get the resources for.
|
|
* @list: Head of the resultant list of resources (must be empty).
|
|
* @preproc: The caller's preprocessing routine.
|
|
* @preproc_data: Pointer passed to the caller's preprocessing routine.
|
|
*
|
|
* Evaluate the _CRS method for the given device node and process its output by
|
|
* (1) executing the @preproc() rountine provided by the caller, passing the
|
|
* resource pointer and @preproc_data to it as arguments, for each ACPI resource
|
|
* returned and (2) converting all of the returned ACPI resources into struct
|
|
* resource objects if possible. If the return value of @preproc() in step (1)
|
|
* is different from 0, step (2) is not applied to the given ACPI resource and
|
|
* if that value is negative, the whole processing is aborted and that value is
|
|
* returned as the final error code.
|
|
*
|
|
* The resultant struct resource objects are put on the list pointed to by
|
|
* @list, that must be empty initially, as members of struct resource_list_entry
|
|
* objects. Callers of this routine should use %acpi_dev_free_resource_list() to
|
|
* free that list.
|
|
*
|
|
* The number of resources in the output list is returned on success, an error
|
|
* code reflecting the error condition is returned otherwise.
|
|
*/
|
|
int acpi_dev_get_resources(struct acpi_device *adev, struct list_head *list,
|
|
int (*preproc)(struct acpi_resource *, void *),
|
|
void *preproc_data)
|
|
{
|
|
struct res_proc_context c;
|
|
acpi_handle not_used;
|
|
acpi_status status;
|
|
|
|
if (!adev || !adev->handle || !list_empty(list))
|
|
return -EINVAL;
|
|
|
|
status = acpi_get_handle(adev->handle, METHOD_NAME__CRS, ¬_used);
|
|
if (ACPI_FAILURE(status))
|
|
return 0;
|
|
|
|
c.list = list;
|
|
c.preproc = preproc;
|
|
c.preproc_data = preproc_data;
|
|
c.count = 0;
|
|
c.error = 0;
|
|
status = acpi_walk_resources(adev->handle, METHOD_NAME__CRS,
|
|
acpi_dev_process_resource, &c);
|
|
if (ACPI_FAILURE(status)) {
|
|
acpi_dev_free_resource_list(list);
|
|
return c.error ? c.error : -EIO;
|
|
}
|
|
|
|
return c.count;
|
|
}
|
|
EXPORT_SYMBOL_GPL(acpi_dev_get_resources);
|