drivers/mfd/rt5025-irq.c

   1 /*
   2  *  drivers/mfd/rt5025-irq.c
   3  *  Driver foo Richtek RT5025 PMIC irq
   4  *
   5  *  Copyright (C) 2013 Richtek Electronics
   6  *  cy_huang <cy_huang@richtek.com>
   7  *
   8  * This program is free software; you can redistribute it and/or modify
   9  * it under the terms of the GNU General Public License version 2 as
  10  * published by the Free Software Foundation.
  11  */
  12
  13 #include <linux/module.h>
  14 #include <linux/kernel.h>
  15 #include <linux/err.h>
  16 #include <linux/i2c.h>
  17 #include <linux/platform_device.h>
  18 #include <linux/slab.h>
  19
  20 #include <linux/gpio.h>
  21 #include <linux/irq.h>
  22 #include <linux/interrupt.h>
  23 #include <linux/workqueue.h>
  24
  25 #include <linux/mfd/rt5025.h>
  26 #include <linux/mfd/rt5025-irq.h>
  27
  28 struct rt5025_irq_info {
  29         struct i2c_client *i2c;
  30         struct device *dev;
  31         struct rt5025_chip *chip;
  32         struct workqueue_struct *wq;
  33         struct rt5025_event_callback *event_cb;
  34         struct delayed_work delayed_work;
  35         int intr_pin;
  36         int irq;
  37 };
  38
  39 static void rt5025_work_func(struct work_struct *work)
  40 {
  41         struct delayed_work *delayed_work = (struct delayed_work *)container_of(work, struct delayed_work, work);
  42         struct rt5025_irq_info *ii = (struct rt5025_irq_info *)container_of(delayed_work, struct rt5025_irq_info, delayed_work);
  43         unsigned char irq_stat[10] = {0};
  44         uint32_t chg_event = 0, pwr_event = 0;
  45
  46         if (rt5025_reg_block_read(ii->i2c, RT5025_REG_IRQEN1, 10, irq_stat) >= 0)
  47         {
  48                 RTINFO("irq1->%02x, irq2->%02x, irq3->%02x\n", irq_stat[1], irq_stat[3], irq_stat[5]);
  49                 RTINFO("irq4->%02x, irq5->%02x\n", irq_stat[7], irq_stat[9]);
  50                 RTINFO("stat value = %02x\n", rt5025_reg_read(ii->i2c, RT5025_REG_CHGSTAT));
  51
  52                 chg_event = irq_stat[1]<<16 | irq_stat[3]<<8 | irq_stat[5];
  53                 pwr_event = irq_stat[7]<<8 | irq_stat[9];
  54                 #ifdef CONFIG_POWER_RT5025
  55                 if (chg_event & CHARGER_DETECT_MASK)
  56                         rt5025_power_charge_detect(ii->chip->power_info);
  57                 #endif /* CONFIG_POWER_RT5025 */
  58                 if (ii->event_cb)
  59                 {
  60                         if (chg_event)
  61                                 ii->event_cb->charger_event_callback(chg_event);
  62                         if (pwr_event)
  63                                 ii->event_cb->power_event_callkback(pwr_event);
  64                 }
  65         }
  66         else
  67                 dev_err(ii->dev, "read irq stat io fail\n");
  68
  69         #ifdef CONFIG_POWER_RT5025
  70         rt5025_power_passirq_to_gauge(ii->chip->power_info);
  71         #endif /* CONFIG_POWER_RT5025 */
  72
  73         enable_irq(ii->irq);
  74 }
  75
  76 static irqreturn_t rt5025_interrupt(int irqno, void *param)
  77 {
  78         struct rt5025_irq_info *ii = (struct rt5025_irq_info *)param;
  79
  80         disable_irq_nosync(ii->irq);
  81         queue_delayed_work(ii->wq, &ii->delayed_work, 0);
  82         return IRQ_HANDLED;
  83 }
  84
  85 static int __devinit rt5025_interrupt_init(struct rt5025_irq_info* ii)
  86 {
  87         int ret;
  88
  89         RTINFO("\n");
  90         ii->wq = create_workqueue("rt5025_wq");
  91         INIT_DELAYED_WORK(&ii->delayed_work, rt5025_work_func);
  92
  93         if (gpio_is_valid(ii->intr_pin))
  94         {
  95                 ret = gpio_request(ii->intr_pin, "rt5025_interrupt");
  96                 if (ret)
  97                         return ret;
  98
  99                 ret = gpio_direction_input(ii->intr_pin);
 100                 if (ret)
 101                         return ret;
 102
 103                 if (request_irq(ii->irq, rt5025_interrupt, IRQ_TYPE_EDGE_FALLING|IRQF_DISABLED, "RT5025_IRQ", ii))
 104                 {
 105                         dev_err(ii->dev, "couldn't allocate IRQ_NO(%d) !\n", ii->irq);
 106                         return -EINVAL;
 107                 }
 108                 enable_irq_wake(ii->irq);
 109
 110                 if (!gpio_get_value(ii->intr_pin))
 111                 {
 112                         disable_irq_nosync(ii->irq);
 113                         queue_delayed_work(ii->wq, &ii->delayed_work, 0);
 114                 }
 115         }
 116         else
 117                 return -EINVAL;
 118
 119         return 0;
 120 }
 121
 122 static void __devexit rt5025_interrupt_deinit(struct rt5025_irq_info* ii)
 123 {
 124         if (ii->irq)
 125                 free_irq(ii->irq, ii);
 126
 127         if (ii->wq)
 128         {
 129                 cancel_delayed_work_sync(&ii->delayed_work);
 130                 flush_workqueue(ii->wq);
 131                 destroy_workqueue(ii->wq);
 132         }
 133 }
 134
 135 static int __devinit rt5025_irq_reg_init(struct rt5025_irq_info* ii, struct rt5025_irq_data* irq_data)
 136 {
 137         RTINFO("\n");
 138         // will just enable the interrupt that we want
 139         rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN1, irq_data->irq_enable1.val);
 140         rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN2, irq_data->irq_enable2.val);
 141         rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN3, irq_data->irq_enable3.val);
 142         rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN4, irq_data->irq_enable4.val);
 143         rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN5, irq_data->irq_enable5.val);
 144         return 0;
 145 }
 146
 147 static int __devinit rt5025_irq_probe(struct platform_device *pdev)
 148 {
 149         struct rt5025_chip *chip = dev_get_drvdata(pdev->dev.parent);
 150         struct rt5025_platform_data *pdata = chip->dev->platform_data;
 151         struct rt5025_irq_info *ii;
 152         printk("%s,line=%d\n", __func__,__LINE__);
 153
 154         RTINFO("\n");
 155         ii = kzalloc(sizeof(*ii), GFP_KERNEL);
 156         if (!ii)
 157                 return -ENOMEM;
 158
 159         ii->i2c = chip->i2c;
 160         ii->dev = &pdev->dev;
 161         ii->chip = chip;
 162         ii->intr_pin = pdata->intr_pin;
 163         ii->irq = gpio_to_irq(pdata->intr_pin);
 164         if (pdata->cb)
 165                 ii->event_cb = pdata->cb;
 166
 167         rt5025_irq_reg_init(ii, pdata->irq_data);
 168         rt5025_interrupt_init(ii);
 169
 170         platform_set_drvdata(pdev, ii);
 171         return 0;
 172 }
 173
 174 static int __devexit rt5025_irq_remove(struct platform_device *pdev)
 175 {
 176         struct rt5025_irq_info *ii = platform_get_drvdata(pdev);
 177
 178         rt5025_interrupt_deinit(ii);
 179         platform_set_drvdata(pdev, NULL);
 180         return 0;
 181 }
 182
 183 static struct platform_driver rt5025_irq_driver =
 184 {
 185         .driver = {
 186                 .name = RT5025_DEVICE_NAME "-irq",
 187                 .owner = THIS_MODULE,
 188         },
 189         .probe = rt5025_irq_probe,
 190         .remove = __devexit_p(rt5025_irq_remove),
 191 };
 192
 193 static int __init rt5025_irq_init(void)
 194 {
 195         return platform_driver_register(&rt5025_irq_driver);
 196 }
 197 subsys_initcall_sync(rt5025_irq_init);
 198
 199 static void __exit rt5025_irq_exit(void)
 200 {
 201         platform_driver_unregister(&rt5025_irq_driver);
 202 }
 203 module_exit(rt5025_irq_exit);
 204
 205 MODULE_LICENSE("GPL v2");
 206 MODULE_AUTHOR("CY Huang <cy_huang@richtek.com");
 207 MODULE_DESCRIPTION("IRQ driver for RT5025");
 208 MODULE_ALIAS("platform:" RT5025_DEVICE_NAME "-irq");