Port ftrace to markers

[linux-2.6-omap-h63xx.git] / drivers / power / pda_power.c

diff --git a/drivers/power/pda_power.c b/drivers/power/pda_power.c
index d6c6dbc20e2acff9ee4d66231b4e9449c93caa8a..82810b7bff9ccbf7b2dd183f7e49e4036239ff66 100644 (file)
--- a/drivers/power/pda_power.c
+++ b/drivers/power/pda_power.c
@@ -32,6 +32,8 @@ static struct pda_power_pdata *pdata;
 static struct resource *ac_irq, *usb_irq;
 static struct timer_list charger_timer;
 static struct timer_list supply_timer;
+static struct timer_list polling_timer;
+static int polling;
 
 enum {
        PDA_PSY_OFFLINE = 0,
@@ -167,6 +169,31 @@ static irqreturn_t power_changed_isr(int irq, void *power_supply)
        return IRQ_HANDLED;
 }
 
+static void polling_timer_func(unsigned long unused)
+{
+       int changed = 0;
+
+       dev_dbg(dev, "polling...\n");
+
+       update_status();
+
+       if (!ac_irq && new_ac_status != ac_status) {
+               ac_status = PDA_PSY_TO_CHANGE;
+               changed = 1;
+       }
+
+       if (!usb_irq && new_usb_status != usb_status) {
+               usb_status = PDA_PSY_TO_CHANGE;
+               changed = 1;
+       }
+
+       if (changed)
+               psy_changed();
+
+       mod_timer(&polling_timer,
+                 jiffies + msecs_to_jiffies(pdata->polling_interval));
+}
+
 static int pda_power_probe(struct platform_device *pdev)
 {
        int ret = 0;
@@ -182,6 +209,12 @@ static int pda_power_probe(struct platform_device *pdev)
 
        pdata = pdev->dev.platform_data;
 
+       if (pdata->init) {
+               ret = pdata->init(dev);
+               if (ret < 0)
+                       goto init_failed;
+       }
+
        update_status();
        update_charger();
 
@@ -191,6 +224,9 @@ static int pda_power_probe(struct platform_device *pdev)
        if (!pdata->wait_for_charger)
                pdata->wait_for_charger = 500;
 
+       if (!pdata->polling_interval)
+               pdata->polling_interval = 2000;
+
        setup_timer(&charger_timer, charger_timer_func, 0);
        setup_timer(&supply_timer, supply_timer_func, 0);
 
@@ -220,6 +256,8 @@ static int pda_power_probe(struct platform_device *pdev)
                                dev_err(dev, "request ac irq failed\n");
                                goto ac_irq_failed;
                        }
+               } else {
+                       polling = 1;
                }
        }
 
@@ -239,10 +277,20 @@ static int pda_power_probe(struct platform_device *pdev)
                                dev_err(dev, "request usb irq failed\n");
                                goto usb_irq_failed;
                        }
+               } else {
+                       polling = 1;
                }
        }
 
-       device_init_wakeup(&pdev->dev, 1);
+       if (polling) {
+               dev_dbg(dev, "will poll for status\n");
+               setup_timer(&polling_timer, polling_timer_func, 0);
+               mod_timer(&polling_timer,
+                         jiffies + msecs_to_jiffies(pdata->polling_interval));
+       }
+
+       if (ac_irq || usb_irq)
+               device_init_wakeup(&pdev->dev, 1);
 
        return 0;
 
@@ -256,6 +304,9 @@ ac_irq_failed:
        if (pdata->is_ac_online)
                power_supply_unregister(&pda_psy_ac);
 ac_supply_failed:
+       if (pdata->exit)
+               pdata->exit(dev);
+init_failed:
 wrongid:
        return ret;
 }
@@ -267,6 +318,8 @@ static int pda_power_remove(struct platform_device *pdev)
        if (pdata->is_ac_online && ac_irq)
                free_irq(ac_irq->start, &pda_psy_ac);
 
+       if (polling)
+               del_timer_sync(&polling_timer);
        del_timer_sync(&charger_timer);
        del_timer_sync(&supply_timer);
 
@@ -274,6 +327,8 @@ static int pda_power_remove(struct platform_device *pdev)
                power_supply_unregister(&pda_psy_usb);
        if (pdata->is_ac_online)
                power_supply_unregister(&pda_psy_ac);
+       if (pdata->exit)
+               pdata->exit(dev);
 
        return 0;
 }