ACPI: EC: Unify poll and interrupt mode transaction functions
Signed-off-by: Alexey Y. Starikovskiy <alexey.y.starikovskiy@intel.com> Signed-off-by: Len Brown <len.brown@intel.com>
This commit is contained in:
parent
703959d47e
commit
3576cf619b
@ -112,12 +112,6 @@ static struct acpi_ec *ec_ecdt;
|
|||||||
static struct acpi_device *first_ec;
|
static struct acpi_device *first_ec;
|
||||||
static int acpi_ec_mode = EC_INTR;
|
static int acpi_ec_mode = EC_INTR;
|
||||||
|
|
||||||
static int acpi_ec_poll_transaction(struct acpi_ec *ec, u8 command,
|
|
||||||
const u8 *wdata, unsigned wdata_len,
|
|
||||||
u8 *rdata, unsigned rdata_len);
|
|
||||||
static int acpi_ec_intr_transaction(struct acpi_ec *ec, u8 command,
|
|
||||||
const u8 *wdata, unsigned wdata_len,
|
|
||||||
u8 *rdata, unsigned rdata_len);
|
|
||||||
static void acpi_ec_gpe_poll_query(void *ec_cxt);
|
static void acpi_ec_gpe_poll_query(void *ec_cxt);
|
||||||
static void acpi_ec_gpe_intr_query(void *ec_cxt);
|
static void acpi_ec_gpe_intr_query(void *ec_cxt);
|
||||||
static u32 acpi_ec_gpe_poll_handler(void *data);
|
static u32 acpi_ec_gpe_poll_handler(void *data);
|
||||||
@ -257,29 +251,6 @@ int acpi_ec_leave_burst_mode(struct acpi_ec *ec)
|
|||||||
}
|
}
|
||||||
#endif /* ACPI_FUTURE_USAGE */
|
#endif /* ACPI_FUTURE_USAGE */
|
||||||
|
|
||||||
static int acpi_ec_transaction(struct acpi_ec *ec, u8 command,
|
|
||||||
const u8 *wdata, unsigned wdata_len,
|
|
||||||
u8 *rdata, unsigned rdata_len)
|
|
||||||
{
|
|
||||||
if (acpi_ec_mode == EC_POLL)
|
|
||||||
return acpi_ec_poll_transaction(ec, command, wdata, wdata_len, rdata, rdata_len);
|
|
||||||
else
|
|
||||||
return acpi_ec_intr_transaction(ec, command, wdata, wdata_len, rdata, rdata_len);
|
|
||||||
}
|
|
||||||
static int acpi_ec_read(struct acpi_ec *ec, u8 address, u32 * data)
|
|
||||||
{
|
|
||||||
int result;
|
|
||||||
u8 d;
|
|
||||||
result = acpi_ec_transaction(ec, ACPI_EC_COMMAND_READ, &address, 1, &d, 1);
|
|
||||||
*data = d;
|
|
||||||
return result;
|
|
||||||
}
|
|
||||||
static int acpi_ec_write(struct acpi_ec *ec, u8 address, u8 data)
|
|
||||||
{
|
|
||||||
u8 wdata[2] = { address, data };
|
|
||||||
return acpi_ec_transaction(ec, ACPI_EC_COMMAND_WRITE, wdata, 2, NULL, 0);
|
|
||||||
}
|
|
||||||
|
|
||||||
static int acpi_ec_transaction_unlocked(struct acpi_ec *ec, u8 command,
|
static int acpi_ec_transaction_unlocked(struct acpi_ec *ec, u8 command,
|
||||||
const u8 *wdata, unsigned wdata_len,
|
const u8 *wdata, unsigned wdata_len,
|
||||||
u8 *rdata, unsigned rdata_len)
|
u8 *rdata, unsigned rdata_len)
|
||||||
@ -292,7 +263,6 @@ static int acpi_ec_transaction_unlocked(struct acpi_ec *ec, u8 command,
|
|||||||
result = acpi_ec_wait(ec, ACPI_EC_EVENT_IBF_0);
|
result = acpi_ec_wait(ec, ACPI_EC_EVENT_IBF_0);
|
||||||
if (result)
|
if (result)
|
||||||
return result;
|
return result;
|
||||||
|
|
||||||
acpi_ec_write_data(ec, *(wdata++));
|
acpi_ec_write_data(ec, *(wdata++));
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -316,44 +286,7 @@ static int acpi_ec_transaction_unlocked(struct acpi_ec *ec, u8 command,
|
|||||||
return 0;
|
return 0;
|
||||||
}
|
}
|
||||||
|
|
||||||
static int acpi_ec_poll_transaction(struct acpi_ec *ec, u8 command,
|
static int acpi_ec_transaction(struct acpi_ec *ec, u8 command,
|
||||||
const u8 *wdata, unsigned wdata_len,
|
|
||||||
u8 *rdata, unsigned rdata_len)
|
|
||||||
{
|
|
||||||
acpi_status status = AE_OK;
|
|
||||||
int result;
|
|
||||||
u32 glk = 0;
|
|
||||||
|
|
||||||
if (!ec || (wdata_len && !wdata) || (rdata_len && !rdata))
|
|
||||||
return -EINVAL;
|
|
||||||
|
|
||||||
if (rdata)
|
|
||||||
memset(rdata, 0, rdata_len);
|
|
||||||
|
|
||||||
if (ec->global_lock) {
|
|
||||||
status = acpi_acquire_global_lock(ACPI_EC_UDELAY_GLK, &glk);
|
|
||||||
if (ACPI_FAILURE(status))
|
|
||||||
return -ENODEV;
|
|
||||||
}
|
|
||||||
|
|
||||||
if (down_interruptible(&ec->sem)) {
|
|
||||||
result = -ERESTARTSYS;
|
|
||||||
goto end_nosem;
|
|
||||||
}
|
|
||||||
|
|
||||||
result = acpi_ec_transaction_unlocked(ec, command,
|
|
||||||
wdata, wdata_len,
|
|
||||||
rdata, rdata_len);
|
|
||||||
up(&ec->sem);
|
|
||||||
|
|
||||||
end_nosem:
|
|
||||||
if (ec->global_lock)
|
|
||||||
acpi_release_global_lock(glk);
|
|
||||||
|
|
||||||
return result;
|
|
||||||
}
|
|
||||||
|
|
||||||
static int acpi_ec_intr_transaction(struct acpi_ec *ec, u8 command,
|
|
||||||
const u8 *wdata, unsigned wdata_len,
|
const u8 *wdata, unsigned wdata_len,
|
||||||
u8 *rdata, unsigned rdata_len)
|
u8 *rdata, unsigned rdata_len)
|
||||||
{
|
{
|
||||||
@ -371,13 +304,11 @@ static int acpi_ec_intr_transaction(struct acpi_ec *ec, u8 command,
|
|||||||
if (ACPI_FAILURE(status))
|
if (ACPI_FAILURE(status))
|
||||||
return -ENODEV;
|
return -ENODEV;
|
||||||
}
|
}
|
||||||
|
|
||||||
WARN_ON(in_interrupt());
|
|
||||||
down(&ec->sem);
|
down(&ec->sem);
|
||||||
|
|
||||||
status = acpi_ec_wait(ec, ACPI_EC_EVENT_IBF_0);
|
status = acpi_ec_wait(ec, ACPI_EC_EVENT_IBF_0);
|
||||||
if (status) {
|
if (status) {
|
||||||
ACPI_EXCEPTION((AE_INFO, status, "read EC, IB not empty"));
|
printk(KERN_DEBUG PREFIX "read EC, IB not empty\n");
|
||||||
goto end;
|
goto end;
|
||||||
}
|
}
|
||||||
|
|
||||||
@ -394,6 +325,23 @@ end:
|
|||||||
return status;
|
return status;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int acpi_ec_read(struct acpi_ec *ec, u8 address, u32 * data)
|
||||||
|
{
|
||||||
|
int result;
|
||||||
|
u8 d;
|
||||||
|
|
||||||
|
result = acpi_ec_transaction(ec, ACPI_EC_COMMAND_READ,
|
||||||
|
&address, 1, &d, 1);
|
||||||
|
*data = d;
|
||||||
|
return result;
|
||||||
|
}
|
||||||
|
static int acpi_ec_write(struct acpi_ec *ec, u8 address, u8 data)
|
||||||
|
{
|
||||||
|
u8 wdata[2] = { address, data };
|
||||||
|
return acpi_ec_transaction(ec, ACPI_EC_COMMAND_WRITE,
|
||||||
|
wdata, 2, NULL, 0);
|
||||||
|
}
|
||||||
|
|
||||||
/*
|
/*
|
||||||
* Externally callable EC access functions. For now, assume 1 EC only
|
* Externally callable EC access functions. For now, assume 1 EC only
|
||||||
*/
|
*/
|
||||||
@ -447,12 +395,12 @@ extern int ec_transaction(u8 command,
|
|||||||
|
|
||||||
ec = acpi_driver_data(first_ec);
|
ec = acpi_driver_data(first_ec);
|
||||||
|
|
||||||
return acpi_ec_transaction(ec, command, wdata, wdata_len, rdata, rdata_len);
|
return acpi_ec_transaction(ec, command, wdata,
|
||||||
|
wdata_len, rdata, rdata_len);
|
||||||
}
|
}
|
||||||
|
|
||||||
EXPORT_SYMBOL(ec_transaction);
|
static int acpi_ec_query(struct acpi_ec *ec, u32 * data)
|
||||||
|
{
|
||||||
static int acpi_ec_query(struct acpi_ec *ec, u32 * data) {
|
|
||||||
int result;
|
int result;
|
||||||
u8 d;
|
u8 d;
|
||||||
|
|
||||||
|
Loading…
Reference in New Issue
Block a user