#include <linux/i2c.h>
#include <linux/platform_device.h>
#include <linux/slab.h>
+#include <linux/wakelock.h>
+#include <linux/delay.h>
#include <linux/gpio.h>
#include <linux/irq.h>
struct workqueue_struct *wq;
struct rt5025_event_callback *event_cb;
struct delayed_work delayed_work;
+ struct wake_lock irq_wake_lock;
int intr_pin;
int irq;
+ int suspend;
+ int acin_cnt;
+ int usbin_cnt;
};
static void rt5025_work_func(struct work_struct *work)
struct delayed_work *delayed_work = (struct delayed_work *)container_of(work, struct delayed_work, work);
struct rt5025_irq_info *ii = (struct rt5025_irq_info *)container_of(delayed_work, struct rt5025_irq_info, delayed_work);
unsigned char irq_stat[6] = {0};
+ unsigned char irq_enable[6] = {0};
uint32_t chg_event = 0, pwr_event = 0;
+ //Add this to prevent i2c xfer before i2c chip is in suspend mode
+ if (ii->suspend)
+ {
+ queue_delayed_work(ii->wq, &ii->delayed_work, msecs_to_jiffies(1));
+ return;
+ }
+
#ifdef CONFIG_POWER_RT5025
if (!ii->chip->power_info || !ii->chip->jeita_info || !ii->chip->battery_info)
{
if (rt5025_reg_block_read(ii->i2c, RT5025_REG_IRQEN1, 10, irq_stat) >= 0)
{
#endif
+ /* backup the irq enable bit */
+ irq_enable[0] = rt5025_reg_read(ii->i2c, RT5025_REG_IRQEN1);
+ irq_enable[1] = rt5025_reg_read(ii->i2c, RT5025_REG_IRQEN2);
+ irq_enable[2] = rt5025_reg_read(ii->i2c, RT5025_REG_IRQEN3);
+ irq_enable[3] = rt5025_reg_read(ii->i2c, RT5025_REG_IRQEN4);
+ irq_enable[4] = rt5025_reg_read(ii->i2c, RT5025_REG_IRQEN5);
+ irq_enable[5] = rt5025_reg_read(ii->i2c, RT5025_REG_GAUGEIRQEN);
+ #if 1
+ rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN2, irq_enable[1]&(~RT5025_CHTERMI_MASK));
+ #else
+ /* disable all irq enable bit first */
+ rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN1, irq_enable[0]&RT5025_ADAPIRQ_MASK);
+ rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN2, 0x00);
+ rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN3, 0x00);
+ rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN4, 0x00);
+ rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN5, 0x00);
+ rt5025_reg_write(ii->i2c, RT5025_REG_GAUGEIRQEN, 0x00);
+ #endif //#if 0
+ /* read irq status bit */
irq_stat[0] = rt5025_reg_read(ii->i2c, RT5025_REG_IRQSTATUS1);
irq_stat[1] = rt5025_reg_read(ii->i2c, RT5025_REG_IRQSTATUS2);
irq_stat[2] = rt5025_reg_read(ii->i2c, RT5025_REG_IRQSTATUS3);
chg_event = irq_stat[0]<<16 | irq_stat[1]<<8 | irq_stat[2];
pwr_event = irq_stat[3]<<8 | irq_stat[4];
#ifdef CONFIG_POWER_RT5025
- if (chg_event & CHARGER_DETECT_MASK)
+ if ((chg_event & CHARGER_DETECT_MASK))
{
if (chg_event & CHG_EVENT_CHTERMI)
+ {
ii->chip->power_info->chg_term++;
- rt5025_power_charge_detect(ii->chip->power_info);
+ if (ii->chip->power_info->chg_term > 3)
+ ii->chip->power_info->chg_term = 4;
+ }
+
+ if (chg_event & CHG_EVENT_CHRCHGI)
+ ii->chip->power_info->chg_term = 0;
+
+ if (chg_event & (CHG_EVENT_CHSLPI_INAC | CHG_EVENT_CHSLPI_INUSB))
+ {
+ ii->chip->power_info->chg_term = 0;
+ if (chg_event & CHG_EVENT_CHSLPI_INAC)
+ ii->acin_cnt = 0;
+ if (chg_event & CHG_EVENT_CHSLPI_INUSB)
+ ii->usbin_cnt = 0;
+
+ }
+
+ if (chg_event & (CHG_EVENT_INAC_PLUGIN | CHG_EVENT_INUSB_PLUGIN))
+ {
+ RTINFO("acin_cnt %d, usbin_cnt %d\n", ii->acin_cnt, ii->usbin_cnt);
+ if (ii->acin_cnt == 0 && ii->usbin_cnt == 0)
+ {
+ #if 1
+ rt5025_charger_reset_and_reinit(ii->chip->power_info);
+ rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN1, irq_enable[0]);
+ rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN2, irq_enable[1]&(~RT5025_CHTERMI_MASK));
+ rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN3, irq_enable[2]);
+ #else
+ rt5025_set_charging_buck(ii->i2c, 0);
+ mdelay(50);
+ rt5025_set_charging_buck(ii->i2c, 1);
+ mdelay(100);
+ rt5025_set_charging_buck(ii->i2c, 0);
+ mdelay(50);
+ rt5025_set_charging_buck(ii->i2c, 1);
+ mdelay(400);
+ #endif /* #if 1 */
+ }
+
+ if (chg_event & CHG_EVENT_INAC_PLUGIN)
+ ii->acin_cnt = 1;
+ if (chg_event & CHG_EVENT_INUSB_PLUGIN)
+ ii->usbin_cnt = 1;
+ RTINFO("acin_cnt %d, usbin_cnt %d\n", ii->acin_cnt, ii->usbin_cnt);
+ }
+
+ if (ii->chip->power_info->chg_term <= 3)
+ rt5025_power_charge_detect(ii->chip->power_info);
+
}
#endif /* CONFIG_POWER_RT5025 */
if (ii->event_cb)
rt5025_gauge_irq_handler(ii->chip->battery_info, irq_stat[5] & RT5025_FLG_VOLT);
#endif /* CONFIG_POWER_RT5025 */
+ #if 1
+ rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN2, irq_enable[1]);
+ #else
+ /* restore all irq enable bit */
+ rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN1, irq_enable[0]);
+ rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN2, irq_enable[1]);
+ rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN3, irq_enable[2]);
+ rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN4, irq_enable[3]);
+ rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN5, irq_enable[4]);
+ if (rt5025_reg_read(ii->i2c, RT5025_REG_GAUGEIRQEN) == 0)
+ rt5025_reg_write(ii->i2c, RT5025_REG_GAUGEIRQEN, irq_enable[5]);
+ #endif //#if 0
+
//enable_irq(ii->irq);
}
struct rt5025_irq_info *ii = (struct rt5025_irq_info *)param;
//disable_irq_nosync(ii->irq);
+ wake_lock_timeout(&ii->irq_wake_lock, 1*HZ);
queue_delayed_work(ii->wq, &ii->delayed_work, 0);
return IRQ_HANDLED;
}
ii->irq = chip->irq;//gpio_to_irq(pdata->intr_pin);
if (pdata->cb)
ii->event_cb = pdata->cb;
+ wake_lock_init(&ii->irq_wake_lock, WAKE_LOCK_SUSPEND, "rt_irq_wake");
rt5025_irq_reg_init(ii, pdata->irq_data);
rt5025_interrupt_init(ii);
platform_set_drvdata(pdev, ii);
+ RTINFO("\n");
return 0;
}
{
struct rt5025_irq_info *ii = platform_get_drvdata(pdev);
+ wake_lock_destroy(&ii->irq_wake_lock);
rt5025_interrupt_deinit(ii);
platform_set_drvdata(pdev, NULL);
+ kfree(ii);
+ RTINFO("\n");
return 0;
}
cancel_delayed_work_sync(&ii->delayed_work);
flush_workqueue(ii->wq);
}
+ RTINFO("\n");
+}
+
+static int rt5025_irq_suspend(struct platform_device *pdev, pm_message_t state)
+{
+ struct rt5025_irq_info *ii = platform_get_drvdata(pdev);
+
+ RTINFO("\n");
+ ii->suspend = 1;
+ return 0;
+}
+
+static int rt5025_irq_resume(struct platform_device *pdev)
+{
+ struct rt5025_irq_info *ii = platform_get_drvdata(pdev);
+
+ RTINFO("\n");
+ ii->suspend = 0;
+ return 0;
}
static struct platform_driver rt5025_irq_driver =
.probe = rt5025_irq_probe,
.remove = __devexit_p(rt5025_irq_remove),
.shutdown = rt5025_irq_shutdown,
+ .suspend = rt5025_irq_suspend,
+ .resume = rt5025_irq_resume,
};
static int __init rt5025_irq_init(void)
{
return platform_driver_register(&rt5025_irq_driver);
}
-subsys_initcall_sync(rt5025_irq_init);
+module_init(rt5025_irq_init);
static void __exit rt5025_irq_exit(void)
{
MODULE_AUTHOR("CY Huang <cy_huang@richtek.com");
MODULE_DESCRIPTION("IRQ driver for RT5025");
MODULE_ALIAS("platform:" RT5025_DEVICE_NAME "-irq");
+MODULE_VERSION(RT5025_DRV_VER);