提交 c93a3ae2 编写于 作者: W Wang Dongsheng 提交者: Linus Torvalds

drivers/rtc/rtc-ds3232.c: enable ds3232 to work as wakeup source

Add suspend/resume and device_init_wakeup to enable ds3232 as wakeup
source, /sys/class/rtc/rtcX/wakealarm for set wakeup alarm.
Signed-off-by: NWang Dongsheng <dongsheng.wang@freescale.com>
Signed-off-by: NAndrew Morton <akpm@linux-foundation.org>
Signed-off-by: NLinus Torvalds <torvalds@linux-foundation.org>
上级 3f93822d
...@@ -57,6 +57,7 @@ struct ds3232 { ...@@ -57,6 +57,7 @@ struct ds3232 {
* in the remove function. * in the remove function.
*/ */
struct mutex mutex; struct mutex mutex;
bool suspended;
int exiting; int exiting;
}; };
...@@ -345,7 +346,15 @@ static irqreturn_t ds3232_irq(int irq, void *dev_id) ...@@ -345,7 +346,15 @@ static irqreturn_t ds3232_irq(int irq, void *dev_id)
struct ds3232 *ds3232 = i2c_get_clientdata(client); struct ds3232 *ds3232 = i2c_get_clientdata(client);
disable_irq_nosync(irq); disable_irq_nosync(irq);
schedule_work(&ds3232->work);
/*
* If rtc as a wakeup source, can't schedule the work
* at system resume flow, because at this time the i2c bus
* has not been resumed.
*/
if (!ds3232->suspended)
schedule_work(&ds3232->work);
return IRQ_HANDLED; return IRQ_HANDLED;
} }
...@@ -363,22 +372,26 @@ static void ds3232_work(struct work_struct *work) ...@@ -363,22 +372,26 @@ static void ds3232_work(struct work_struct *work)
if (stat & DS3232_REG_SR_A1F) { if (stat & DS3232_REG_SR_A1F) {
control = i2c_smbus_read_byte_data(client, DS3232_REG_CR); control = i2c_smbus_read_byte_data(client, DS3232_REG_CR);
if (control < 0) if (control < 0) {
goto out; pr_warn("Read DS3232 Control Register error."
/* disable alarm1 interrupt */ "Disable IRQ%d.\n", client->irq);
control &= ~(DS3232_REG_CR_A1IE); } else {
i2c_smbus_write_byte_data(client, DS3232_REG_CR, control); /* disable alarm1 interrupt */
control &= ~(DS3232_REG_CR_A1IE);
/* clear the alarm pend flag */ i2c_smbus_write_byte_data(client, DS3232_REG_CR,
stat &= ~DS3232_REG_SR_A1F; control);
i2c_smbus_write_byte_data(client, DS3232_REG_SR, stat);
/* clear the alarm pend flag */
rtc_update_irq(ds3232->rtc, 1, RTC_AF | RTC_IRQF); stat &= ~DS3232_REG_SR_A1F;
i2c_smbus_write_byte_data(client, DS3232_REG_SR, stat);
rtc_update_irq(ds3232->rtc, 1, RTC_AF | RTC_IRQF);
if (!ds3232->exiting)
enable_irq(client->irq);
}
} }
out:
if (!ds3232->exiting)
enable_irq(client->irq);
unlock: unlock:
mutex_unlock(&ds3232->mutex); mutex_unlock(&ds3232->mutex);
} }
...@@ -411,21 +424,17 @@ static int ds3232_probe(struct i2c_client *client, ...@@ -411,21 +424,17 @@ static int ds3232_probe(struct i2c_client *client,
if (ret) if (ret)
return ret; return ret;
ds3232->rtc = devm_rtc_device_register(&client->dev, client->name, if (client->irq > 0) {
&ds3232_rtc_ops, THIS_MODULE);
if (IS_ERR(ds3232->rtc)) {
return PTR_ERR(ds3232->rtc);
}
if (client->irq >= 0) {
ret = devm_request_irq(&client->dev, client->irq, ds3232_irq, ret = devm_request_irq(&client->dev, client->irq, ds3232_irq,
IRQF_SHARED, "ds3232", client); IRQF_SHARED, "ds3232", client);
if (ret) { if (ret) {
dev_err(&client->dev, "unable to request IRQ\n"); dev_err(&client->dev, "unable to request IRQ\n");
} }
device_init_wakeup(&client->dev, 1);
} }
ds3232->rtc = devm_rtc_device_register(&client->dev, client->name,
return 0; &ds3232_rtc_ops, THIS_MODULE);
return PTR_ERR_OR_ZERO(ds3232->rtc);
} }
static int ds3232_remove(struct i2c_client *client) static int ds3232_remove(struct i2c_client *client)
...@@ -444,6 +453,42 @@ static int ds3232_remove(struct i2c_client *client) ...@@ -444,6 +453,42 @@ static int ds3232_remove(struct i2c_client *client)
return 0; return 0;
} }
#ifdef CONFIG_PM_SLEEP
static int ds3232_suspend(struct device *dev)
{
struct ds3232 *ds3232 = dev_get_drvdata(dev);
struct i2c_client *client = to_i2c_client(dev);
if (device_can_wakeup(dev)) {
ds3232->suspended = true;
irq_set_irq_wake(client->irq, 1);
}
return 0;
}
static int ds3232_resume(struct device *dev)
{
struct ds3232 *ds3232 = dev_get_drvdata(dev);
struct i2c_client *client = to_i2c_client(dev);
if (ds3232->suspended) {
ds3232->suspended = false;
/* Clear the hardware alarm pend flag */
schedule_work(&ds3232->work);
irq_set_irq_wake(client->irq, 0);
}
return 0;
}
#endif
static const struct dev_pm_ops ds3232_pm_ops = {
SET_SYSTEM_SLEEP_PM_OPS(ds3232_suspend, ds3232_resume)
};
static const struct i2c_device_id ds3232_id[] = { static const struct i2c_device_id ds3232_id[] = {
{ "ds3232", 0 }, { "ds3232", 0 },
{ } { }
...@@ -454,6 +499,7 @@ static struct i2c_driver ds3232_driver = { ...@@ -454,6 +499,7 @@ static struct i2c_driver ds3232_driver = {
.driver = { .driver = {
.name = "rtc-ds3232", .name = "rtc-ds3232",
.owner = THIS_MODULE, .owner = THIS_MODULE,
.pm = &ds3232_pm_ops,
}, },
.probe = ds3232_probe, .probe = ds3232_probe,
.remove = ds3232_remove, .remove = ds3232_remove,
......
Markdown is supported
0% .
You are about to add 0 people to the discussion. Proceed with caution.
先完成此消息的编辑!
想要评论请 注册