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         #ifdef CONFIG_POWER_RT5025
  47         if (!ii->chip->power_info)
  48         {
  49                 queue_delayed_work(ii->wq, &ii->delayed_work, msecs_to_jiffies(1));
  50                 return;
  51         }
  52         #endif
  53
  54         //if (rt5025_reg_block_read(ii->i2c, RT5025_REG_IRQEN1, 10, irq_stat) >= 0)
  55         {
  56                 irq_stat[1] = rt5025_reg_read(ii->i2c, 0x31);
  57                 irq_stat[3] = rt5025_reg_read(ii->i2c, 0x33);
  58                 irq_stat[5] = rt5025_reg_read(ii->i2c, 0x35);
  59                 irq_stat[7] = rt5025_reg_read(ii->i2c, 0x37);
  60                 irq_stat[9] = rt5025_reg_read(ii->i2c, 0x39);
  61                 RTINFO("irq1->%02x, irq2->%02x, irq3->%02x\n", irq_stat[1], irq_stat[3], irq_stat[5]);
  62                 RTINFO("irq4->%02x, irq5->%02x\n", irq_stat[7], irq_stat[9]);
  63                 RTINFO("stat value = %02x\n", rt5025_reg_read(ii->i2c, RT5025_REG_CHGSTAT));
  64
  65                 chg_event = irq_stat[1]<<16 | irq_stat[3]<<8 | irq_stat[5];
  66                 pwr_event = irq_stat[7]<<8 | irq_stat[9];
  67                 #ifdef CONFIG_POWER_RT5025
  68                 if (chg_event & CHARGER_DETECT_MASK)
  69                         rt5025_power_charge_detect(ii->chip->power_info);
  70                 #endif /* CONFIG_POWER_RT5025 */
  71                 if (ii->event_cb)
  72                 {
  73                         if (chg_event)
  74                                 ii->event_cb->charger_event_callback(chg_event);
  75                         if (pwr_event)
  76                                 ii->event_cb->power_event_callkback(pwr_event);
  77                 }
  78         }
  79         #if 0
  80         else
  81                 dev_err(ii->dev, "read irq stat io fail\n");
  82         #endif
  83
  84
  85         #ifdef CONFIG_POWER_RT5025
  86         rt5025_power_passirq_to_gauge(ii->chip->power_info);
  87         #endif /* CONFIG_POWER_RT5025 */
  88
  89         //enable_irq(ii->irq);
  90 }
  91
  92 static irqreturn_t rt5025_interrupt(int irqno, void *param)
  93 {
  94         struct rt5025_irq_info *ii = (struct rt5025_irq_info *)param;
  95
  96         //disable_irq_nosync(ii->irq);
  97         queue_delayed_work(ii->wq, &ii->delayed_work, 0);
  98         return IRQ_HANDLED;
  99 }
 100
 101 static int __devinit rt5025_interrupt_init(struct rt5025_irq_info* ii)
 102 {
 103         int ret = 0;
 104
 105         RTINFO("\n");
 106         ii->wq = create_workqueue("rt5025_wq");
 107         INIT_DELAYED_WORK(&ii->delayed_work, rt5025_work_func);
 108
 109         #if 0
 110         if (gpio_is_valid(ii->intr_pin))
 111         {
 112                 ret = gpio_request(ii->intr_pin, "rt5025_interrupt");
 113                 if (ret)
 114                         return ret;
 115
 116                 ret = gpio_direction_input(ii->intr_pin);
 117                 if (ret)
 118                         return ret;
 119         #endif
 120
 121                 if (request_irq(ii->irq, rt5025_interrupt, IRQ_TYPE_EDGE_FALLING|IRQF_DISABLED, "RT5025_IRQ", ii))
 122                 {
 123                         dev_err(ii->dev, "couldn't allocate IRQ_NO(%d) !\n", ii->irq);
 124                         return -EINVAL;
 125                 }
 126                 enable_irq_wake(ii->irq);
 127                 queue_delayed_work(ii->wq, &ii->delayed_work, msecs_to_jiffies(100));
 128         #if 0
 129
 130                 if (!gpio_get_value(ii->intr_pin))
 131                 {
 132                         //disable_irq_nosync(ii->irq);
 133                         queue_delayed_work(ii->wq, &ii->delayed_work, 0);
 134                 }
 135         }
 136         else
 137                 return -EINVAL;
 138         #endif
 139
 140         return ret;
 141 }
 142
 143 static void __devexit rt5025_interrupt_deinit(struct rt5025_irq_info* ii)
 144 {
 145         if (ii->irq)
 146                 free_irq(ii->irq, ii);
 147
 148         if (ii->wq)
 149         {
 150                 cancel_delayed_work_sync(&ii->delayed_work);
 151                 flush_workqueue(ii->wq);
 152                 destroy_workqueue(ii->wq);
 153         }
 154 }
 155
 156 static int __devinit rt5025_irq_reg_init(struct rt5025_irq_info* ii, struct rt5025_irq_data* irq_data)
 157 {
 158         RTINFO("\n");
 159         // will just enable the interrupt that we want
 160         rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN1, irq_data->irq_enable1.val);
 161         rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN2, irq_data->irq_enable2.val);
 162         rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN3, irq_data->irq_enable3.val);
 163         rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN4, irq_data->irq_enable4.val);
 164         rt5025_reg_write(ii->i2c, RT5025_REG_IRQEN5, irq_data->irq_enable5.val);
 165         return 0;
 166 }
 167
 168 static int __devinit rt5025_irq_probe(struct platform_device *pdev)
 169 {
 170         struct rt5025_chip *chip = dev_get_drvdata(pdev->dev.parent);
 171         struct rt5025_platform_data *pdata = chip->dev->platform_data;
 172         struct rt5025_irq_info *ii;
 173         printk("%s,line=%d\n", __func__,__LINE__);
 174
 175         RTINFO("\n");
 176         ii = kzalloc(sizeof(*ii), GFP_KERNEL);
 177         if (!ii)
 178                 return -ENOMEM;
 179
 180         ii->i2c = chip->i2c;
 181         ii->dev = &pdev->dev;
 182         ii->chip = chip;
 183         ii->intr_pin = pdata->intr_pin;
 184         ii->irq = chip->irq;//gpio_to_irq(pdata->intr_pin);
 185         if (pdata->cb)
 186                 ii->event_cb = pdata->cb;
 187
 188         rt5025_irq_reg_init(ii, pdata->irq_data);
 189         rt5025_interrupt_init(ii);
 190
 191         platform_set_drvdata(pdev, ii);
 192         return 0;
 193 }
 194
 195 static int __devexit rt5025_irq_remove(struct platform_device *pdev)
 196 {
 197         struct rt5025_irq_info *ii = platform_get_drvdata(pdev);
 198
 199         rt5025_interrupt_deinit(ii);
 200         platform_set_drvdata(pdev, NULL);
 201         return 0;
 202 }
 203
 204 static struct platform_driver rt5025_irq_driver =
 205 {
 206         .driver = {
 207                 .name = RT5025_DEVICE_NAME "-irq",
 208                 .owner = THIS_MODULE,
 209         },
 210         .probe = rt5025_irq_probe,
 211         .remove = __devexit_p(rt5025_irq_remove),
 212 };
 213
 214 static int __init rt5025_irq_init(void)
 215 {
 216         return platform_driver_register(&rt5025_irq_driver);
 217 }
 218 subsys_initcall_sync(rt5025_irq_init);
 219
 220 static void __exit rt5025_irq_exit(void)
 221 {
 222         platform_driver_unregister(&rt5025_irq_driver);
 223 }
 224 module_exit(rt5025_irq_exit);
 225
 226 MODULE_LICENSE("GPL v2");
 227 MODULE_AUTHOR("CY Huang <cy_huang@richtek.com");
 228 MODULE_DESCRIPTION("IRQ driver for RT5025");
 229 MODULE_ALIAS("platform:" RT5025_DEVICE_NAME "-irq");