Commit 41cb54e2 authored by Akihiro Tsukada's avatar Akihiro Tsukada Committed by Mauro Carvalho Chehab

media: dvb: earth-pt1: add support for suspend/resume

Without this patch, re-loading of the module was required after resume.
Signed-off-by: default avatarAkihiro Tsukada <tskd08@gmail.com>
Signed-off-by: default avatarMauro Carvalho Chehab <mchehab+samsung@kernel.org>
parent b732539e
...@@ -461,12 +461,18 @@ static int pt1_thread(void *data) ...@@ -461,12 +461,18 @@ static int pt1_thread(void *data)
{ {
struct pt1 *pt1; struct pt1 *pt1;
struct pt1_buffer_page *page; struct pt1_buffer_page *page;
bool was_frozen;
pt1 = data; pt1 = data;
set_freezable(); set_freezable();
while (!kthread_should_stop()) { while (!kthread_freezable_should_stop(&was_frozen)) {
try_to_freeze(); if (was_frozen) {
int i;
for (i = 0; i < PT1_NR_ADAPS; i++)
pt1_set_stream(pt1, i, !!pt1->adaps[i]->users);
}
page = pt1->tables[pt1->table_index].bufs[pt1->buf_index].page; page = pt1->tables[pt1->table_index].bufs[pt1->buf_index].page;
if (!pt1_filter(pt1, page)) { if (!pt1_filter(pt1, page)) {
...@@ -1165,6 +1171,98 @@ static void pt1_i2c_init(struct pt1 *pt1) ...@@ -1165,6 +1171,98 @@ static void pt1_i2c_init(struct pt1 *pt1)
pt1_i2c_emit(pt1, i, 0, 0, 1, 1, 0); pt1_i2c_emit(pt1, i, 0, 0, 1, 1, 0);
} }
#ifdef CONFIG_PM_SLEEP
static int pt1_suspend(struct device *dev)
{
struct pci_dev *pdev = to_pci_dev(dev);
struct pt1 *pt1 = pci_get_drvdata(pdev);
pt1_init_streams(pt1);
pt1_disable_ram(pt1);
pt1->power = 0;
pt1->reset = 1;
pt1_update_power(pt1);
return 0;
}
static int pt1_resume(struct device *dev)
{
struct pci_dev *pdev = to_pci_dev(dev);
struct pt1 *pt1 = pci_get_drvdata(pdev);
int ret;
int i;
pt1->power = 0;
pt1->reset = 1;
pt1_update_power(pt1);
pt1_i2c_init(pt1);
pt1_i2c_wait(pt1);
ret = pt1_sync(pt1);
if (ret < 0)
goto resume_err;
pt1_identify(pt1);
ret = pt1_unlock(pt1);
if (ret < 0)
goto resume_err;
ret = pt1_reset_pci(pt1);
if (ret < 0)
goto resume_err;
ret = pt1_reset_ram(pt1);
if (ret < 0)
goto resume_err;
ret = pt1_enable_ram(pt1);
if (ret < 0)
goto resume_err;
pt1_init_streams(pt1);
pt1->power = 1;
pt1_update_power(pt1);
msleep(20);
pt1->reset = 0;
pt1_update_power(pt1);
usleep_range(1000, 2000);
for (i = 0; i < PT1_NR_ADAPS; i++)
dvb_frontend_reinitialise(pt1->adaps[i]->fe);
pt1_init_table_count(pt1);
for (i = 0; i < pt1_nr_tables; i++) {
int j;
for (j = 0; j < PT1_NR_BUFS; j++)
pt1->tables[i].bufs[j].page->upackets[PT1_NR_UPACKETS-1]
= 0;
pt1_increment_table_count(pt1);
}
pt1_register_tables(pt1, pt1->tables[0].addr >> PT1_PAGE_SHIFT);
pt1->table_index = 0;
pt1->buf_index = 0;
for (i = 0; i < PT1_NR_ADAPS; i++) {
pt1->adaps[i]->upacket_count = 0;
pt1->adaps[i]->packet_count = 0;
pt1->adaps[i]->st_count = -1;
}
return 0;
resume_err:
dev_info(&pt1->pdev->dev, "failed to resume PT1/PT2.");
return 0; /* resume anyway */
}
#endif /* CONFIG_PM_SLEEP */
static void pt1_remove(struct pci_dev *pdev) static void pt1_remove(struct pci_dev *pdev)
{ {
struct pt1 *pt1; struct pt1 *pt1;
...@@ -1325,11 +1423,16 @@ static const struct pci_device_id pt1_id_table[] = { ...@@ -1325,11 +1423,16 @@ static const struct pci_device_id pt1_id_table[] = {
}; };
MODULE_DEVICE_TABLE(pci, pt1_id_table); MODULE_DEVICE_TABLE(pci, pt1_id_table);
static SIMPLE_DEV_PM_OPS(pt1_pm_ops, pt1_suspend, pt1_resume);
static struct pci_driver pt1_driver = { static struct pci_driver pt1_driver = {
.name = DRIVER_NAME, .name = DRIVER_NAME,
.probe = pt1_probe, .probe = pt1_probe,
.remove = pt1_remove, .remove = pt1_remove,
.id_table = pt1_id_table, .id_table = pt1_id_table,
#if CONFIG_PM_SLEEP
.driver.pm = &pt1_pm_ops,
#endif
}; };
module_pci_driver(pt1_driver); module_pci_driver(pt1_driver);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment