|
@@ -158,16 +158,17 @@ static int ec_transaction_completed(struct acpi_ec *ec)
|
|
unsigned long flags;
|
|
unsigned long flags;
|
|
int ret = 0;
|
|
int ret = 0;
|
|
spin_lock_irqsave(&ec->lock, flags);
|
|
spin_lock_irqsave(&ec->lock, flags);
|
|
- if (!ec->curr || (ec->curr->flags & ACPI_EC_COMMAND_COMPLETE))
|
|
|
|
|
|
+ if (ec->curr && (ec->curr->flags & ACPI_EC_COMMAND_COMPLETE))
|
|
ret = 1;
|
|
ret = 1;
|
|
spin_unlock_irqrestore(&ec->lock, flags);
|
|
spin_unlock_irqrestore(&ec->lock, flags);
|
|
return ret;
|
|
return ret;
|
|
}
|
|
}
|
|
|
|
|
|
-static void advance_transaction(struct acpi_ec *ec)
|
|
|
|
|
|
+static bool advance_transaction(struct acpi_ec *ec)
|
|
{
|
|
{
|
|
struct transaction *t;
|
|
struct transaction *t;
|
|
u8 status;
|
|
u8 status;
|
|
|
|
+ bool wakeup = false;
|
|
|
|
|
|
pr_debug("===== %s =====\n", in_interrupt() ? "IRQ" : "TASK");
|
|
pr_debug("===== %s =====\n", in_interrupt() ? "IRQ" : "TASK");
|
|
status = acpi_ec_read_status(ec);
|
|
status = acpi_ec_read_status(ec);
|
|
@@ -183,21 +184,25 @@ static void advance_transaction(struct acpi_ec *ec)
|
|
} else if (t->rlen > t->ri) {
|
|
} else if (t->rlen > t->ri) {
|
|
if ((status & ACPI_EC_FLAG_OBF) == 1) {
|
|
if ((status & ACPI_EC_FLAG_OBF) == 1) {
|
|
t->rdata[t->ri++] = acpi_ec_read_data(ec);
|
|
t->rdata[t->ri++] = acpi_ec_read_data(ec);
|
|
- if (t->rlen == t->ri)
|
|
|
|
|
|
+ if (t->rlen == t->ri) {
|
|
t->flags |= ACPI_EC_COMMAND_COMPLETE;
|
|
t->flags |= ACPI_EC_COMMAND_COMPLETE;
|
|
|
|
+ wakeup = true;
|
|
|
|
+ }
|
|
} else
|
|
} else
|
|
goto err;
|
|
goto err;
|
|
} else if (t->wlen == t->wi &&
|
|
} else if (t->wlen == t->wi &&
|
|
- (status & ACPI_EC_FLAG_IBF) == 0)
|
|
|
|
|
|
+ (status & ACPI_EC_FLAG_IBF) == 0) {
|
|
t->flags |= ACPI_EC_COMMAND_COMPLETE;
|
|
t->flags |= ACPI_EC_COMMAND_COMPLETE;
|
|
- return;
|
|
|
|
|
|
+ wakeup = true;
|
|
|
|
+ }
|
|
|
|
+ return wakeup;
|
|
} else {
|
|
} else {
|
|
if ((status & ACPI_EC_FLAG_IBF) == 0) {
|
|
if ((status & ACPI_EC_FLAG_IBF) == 0) {
|
|
acpi_ec_write_cmd(ec, t->command);
|
|
acpi_ec_write_cmd(ec, t->command);
|
|
t->flags |= ACPI_EC_COMMAND_POLL;
|
|
t->flags |= ACPI_EC_COMMAND_POLL;
|
|
} else
|
|
} else
|
|
goto err;
|
|
goto err;
|
|
- return;
|
|
|
|
|
|
+ return wakeup;
|
|
}
|
|
}
|
|
err:
|
|
err:
|
|
/*
|
|
/*
|
|
@@ -208,13 +213,14 @@ err:
|
|
if (in_interrupt() && t)
|
|
if (in_interrupt() && t)
|
|
++t->irq_count;
|
|
++t->irq_count;
|
|
}
|
|
}
|
|
|
|
+ return wakeup;
|
|
}
|
|
}
|
|
|
|
|
|
static void start_transaction(struct acpi_ec *ec)
|
|
static void start_transaction(struct acpi_ec *ec)
|
|
{
|
|
{
|
|
ec->curr->irq_count = ec->curr->wi = ec->curr->ri = 0;
|
|
ec->curr->irq_count = ec->curr->wi = ec->curr->ri = 0;
|
|
ec->curr->flags = 0;
|
|
ec->curr->flags = 0;
|
|
- advance_transaction(ec);
|
|
|
|
|
|
+ (void)advance_transaction(ec);
|
|
}
|
|
}
|
|
|
|
|
|
static int acpi_ec_sync_query(struct acpi_ec *ec, u8 *data);
|
|
static int acpi_ec_sync_query(struct acpi_ec *ec, u8 *data);
|
|
@@ -248,7 +254,7 @@ static int ec_poll(struct acpi_ec *ec)
|
|
return 0;
|
|
return 0;
|
|
}
|
|
}
|
|
spin_lock_irqsave(&ec->lock, flags);
|
|
spin_lock_irqsave(&ec->lock, flags);
|
|
- advance_transaction(ec);
|
|
|
|
|
|
+ (void)advance_transaction(ec);
|
|
spin_unlock_irqrestore(&ec->lock, flags);
|
|
spin_unlock_irqrestore(&ec->lock, flags);
|
|
} while (time_before(jiffies, delay));
|
|
} while (time_before(jiffies, delay));
|
|
pr_debug("controller reset, restart transaction\n");
|
|
pr_debug("controller reset, restart transaction\n");
|
|
@@ -627,12 +633,10 @@ static u32 acpi_ec_gpe_handler(acpi_handle gpe_device,
|
|
struct acpi_ec *ec = data;
|
|
struct acpi_ec *ec = data;
|
|
|
|
|
|
spin_lock_irqsave(&ec->lock, flags);
|
|
spin_lock_irqsave(&ec->lock, flags);
|
|
- advance_transaction(ec);
|
|
|
|
- spin_unlock_irqrestore(&ec->lock, flags);
|
|
|
|
- if (ec_transaction_completed(ec)) {
|
|
|
|
|
|
+ if (advance_transaction(ec))
|
|
wake_up(&ec->wait);
|
|
wake_up(&ec->wait);
|
|
- ec_check_sci(ec, acpi_ec_read_status(ec));
|
|
|
|
- }
|
|
|
|
|
|
+ spin_unlock_irqrestore(&ec->lock, flags);
|
|
|
|
+ ec_check_sci(ec, acpi_ec_read_status(ec));
|
|
return ACPI_INTERRUPT_HANDLED | ACPI_REENABLE_GPE;
|
|
return ACPI_INTERRUPT_HANDLED | ACPI_REENABLE_GPE;
|
|
}
|
|
}
|
|
|
|
|