ACPI: EC: Put install handlers into separate function.
Signed-off-by: Alexey Starikovskiy <alexey.y.starikovskiy@intel.com> Signed-off-by: Len Brown <len.brown@intel.com>
This commit is contained in:
parent
3d02b90be2
commit
e828432104
@ -715,6 +715,28 @@ acpi_ec_io_ports(struct acpi_resource *resource, void *context)
|
|||||||
return AE_OK;
|
return AE_OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int ec_install_handlers(struct acpi_ec *ec)
|
||||||
|
{
|
||||||
|
acpi_status status = acpi_install_gpe_handler(NULL, ec->gpe,
|
||||||
|
ACPI_GPE_EDGE_TRIGGERED,
|
||||||
|
&acpi_ec_gpe_handler, ec);
|
||||||
|
if (ACPI_FAILURE(status))
|
||||||
|
return -ENODEV;
|
||||||
|
acpi_set_gpe_type(NULL, ec->gpe, ACPI_GPE_TYPE_RUNTIME);
|
||||||
|
acpi_enable_gpe(NULL, ec->gpe, ACPI_NOT_ISR);
|
||||||
|
|
||||||
|
status = acpi_install_address_space_handler(ec->handle,
|
||||||
|
ACPI_ADR_SPACE_EC,
|
||||||
|
&acpi_ec_space_handler,
|
||||||
|
&acpi_ec_space_setup, ec);
|
||||||
|
if (ACPI_FAILURE(status)) {
|
||||||
|
acpi_remove_gpe_handler(NULL, ec->gpe, &acpi_ec_gpe_handler);
|
||||||
|
return -ENODEV;
|
||||||
|
}
|
||||||
|
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
static int acpi_ec_start(struct acpi_device *device)
|
static int acpi_ec_start(struct acpi_device *device)
|
||||||
{
|
{
|
||||||
acpi_status status = AE_OK;
|
acpi_status status = AE_OK;
|
||||||
@ -742,28 +764,7 @@ static int acpi_ec_start(struct acpi_device *device)
|
|||||||
ACPI_DEBUG_PRINT((ACPI_DB_INFO, "gpe=0x%02lx, ports=0x%2lx,0x%2lx",
|
ACPI_DEBUG_PRINT((ACPI_DB_INFO, "gpe=0x%02lx, ports=0x%2lx,0x%2lx",
|
||||||
ec->gpe, ec->command_addr, ec->data_addr));
|
ec->gpe, ec->command_addr, ec->data_addr));
|
||||||
|
|
||||||
/*
|
return ec_install_handlers(ec);
|
||||||
* Install GPE handler
|
|
||||||
*/
|
|
||||||
status = acpi_install_gpe_handler(NULL, ec->gpe,
|
|
||||||
ACPI_GPE_EDGE_TRIGGERED,
|
|
||||||
&acpi_ec_gpe_handler, ec);
|
|
||||||
if (ACPI_FAILURE(status)) {
|
|
||||||
return -ENODEV;
|
|
||||||
}
|
|
||||||
acpi_set_gpe_type(NULL, ec->gpe, ACPI_GPE_TYPE_RUNTIME);
|
|
||||||
acpi_enable_gpe(NULL, ec->gpe, ACPI_NOT_ISR);
|
|
||||||
|
|
||||||
status = acpi_install_address_space_handler(ec->handle,
|
|
||||||
ACPI_ADR_SPACE_EC,
|
|
||||||
&acpi_ec_space_handler,
|
|
||||||
&acpi_ec_space_setup, ec);
|
|
||||||
if (ACPI_FAILURE(status)) {
|
|
||||||
acpi_remove_gpe_handler(NULL, ec->gpe, &acpi_ec_gpe_handler);
|
|
||||||
return -ENODEV;
|
|
||||||
}
|
|
||||||
|
|
||||||
return AE_OK;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
static int acpi_ec_stop(struct acpi_device *device, int type)
|
static int acpi_ec_stop(struct acpi_device *device, int type)
|
||||||
@ -818,56 +819,22 @@ static int __init acpi_ec_get_real_ecdt(void)
|
|||||||
ec_ecdt->gpe = ecdt_ptr->gpe;
|
ec_ecdt->gpe = ecdt_ptr->gpe;
|
||||||
ec_ecdt->uid = ecdt_ptr->uid;
|
ec_ecdt->uid = ecdt_ptr->uid;
|
||||||
|
|
||||||
status = acpi_get_handle(NULL, ecdt_ptr->id, &ec_ecdt->handle);
|
ec_ecdt->handle = ACPI_ROOT_OBJECT;
|
||||||
if (ACPI_FAILURE(status)) {
|
|
||||||
goto error;
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
error:
|
|
||||||
ACPI_EXCEPTION((AE_INFO, status, "Could not use ECDT"));
|
|
||||||
kfree(ec_ecdt);
|
|
||||||
ec_ecdt = NULL;
|
|
||||||
|
|
||||||
return -ENODEV;
|
|
||||||
}
|
}
|
||||||
|
|
||||||
int __init acpi_ec_ecdt_probe(void)
|
int __init acpi_ec_ecdt_probe(void)
|
||||||
{
|
{
|
||||||
acpi_status status;
|
|
||||||
int ret;
|
int ret;
|
||||||
|
|
||||||
ret = acpi_ec_get_real_ecdt();
|
ret = acpi_ec_get_real_ecdt();
|
||||||
if (ret)
|
if (ret)
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
/*
|
ret = ec_install_handlers(ec_ecdt);
|
||||||
* Install GPE handler
|
if (!ret)
|
||||||
*/
|
|
||||||
status = acpi_install_gpe_handler(NULL, ec_ecdt->gpe,
|
|
||||||
ACPI_GPE_EDGE_TRIGGERED,
|
|
||||||
&acpi_ec_gpe_handler, ec_ecdt);
|
|
||||||
if (ACPI_FAILURE(status)) {
|
|
||||||
goto error;
|
|
||||||
}
|
|
||||||
acpi_set_gpe_type(NULL, ec_ecdt->gpe, ACPI_GPE_TYPE_RUNTIME);
|
|
||||||
acpi_enable_gpe(NULL, ec_ecdt->gpe, ACPI_NOT_ISR);
|
|
||||||
|
|
||||||
status = acpi_install_address_space_handler(ACPI_ROOT_OBJECT,
|
|
||||||
ACPI_ADR_SPACE_EC,
|
|
||||||
&acpi_ec_space_handler,
|
|
||||||
&acpi_ec_space_setup,
|
|
||||||
ec_ecdt);
|
|
||||||
if (ACPI_FAILURE(status)) {
|
|
||||||
acpi_remove_gpe_handler(NULL, ec_ecdt->gpe,
|
|
||||||
&acpi_ec_gpe_handler);
|
|
||||||
goto error;
|
|
||||||
}
|
|
||||||
|
|
||||||
return 0;
|
return 0;
|
||||||
|
|
||||||
error:
|
|
||||||
ACPI_EXCEPTION((AE_INFO, status, "Could not use ECDT"));
|
|
||||||
kfree(ec_ecdt);
|
kfree(ec_ecdt);
|
||||||
ec_ecdt = NULL;
|
ec_ecdt = NULL;
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user