drivers/mfd/da9052-i2c.c

   1 /*
   2  * I2C access for DA9052 PMICs.
   3  *
   4  * Copyright(c) 2011 Dialog Semiconductor Ltd.
   5  *
   6  * Author: David Dajun Chen <dchen@diasemi.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 as published by
  10  * the Free Software Foundation; either version 2 of the License, or
  11  * (at your option) any later version.
  12  *
  13  */
  14
  15 #include <linux/device.h>
  16 #include <linux/module.h>
  17 #include <linux/input.h>
  18 #include <linux/mfd/core.h>
  19 #include <linux/i2c.h>
  20 #include <linux/err.h>
  21
  22 #include <linux/mfd/da9052/da9052.h>
  23 #include <linux/mfd/da9052/reg.h>
  24
  25 #ifdef CONFIG_OF
  26 #include <linux/of.h>
  27 #include <linux/of_device.h>
  28 #endif
  29
  30 static int da9052_i2c_enable_multiwrite(struct da9052 *da9052)
  31 {
  32         int reg_val, ret;
  33
  34         ret = regmap_read(da9052->regmap, DA9052_CONTROL_B_REG, &reg_val);
  35         if (ret < 0)
  36                 return ret;
  37
  38         if (reg_val & DA9052_CONTROL_B_WRITEMODE) {
  39                 reg_val &= ~DA9052_CONTROL_B_WRITEMODE;
  40                 ret = regmap_write(da9052->regmap, DA9052_CONTROL_B_REG,
  41                                    reg_val);
  42                 if (ret < 0)
  43                         return ret;
  44         }
  45
  46         return 0;
  47 }
  48
  49 static struct i2c_device_id da9052_i2c_id[] = {
  50         {"da9052", DA9052},
  51         {"da9053-aa", DA9053_AA},
  52         {"da9053-ba", DA9053_BA},
  53         {"da9053-bb", DA9053_BB},
  54         {}
  55 };
  56
  57 #ifdef CONFIG_OF
  58 static const struct of_device_id dialog_dt_ids[] = {
  59         { .compatible = "dlg,da9052", .data = &da9052_i2c_id[0] },
  60         { .compatible = "dlg,da9053-aa", .data = &da9052_i2c_id[1] },
  61         { .compatible = "dlg,da9053-ab", .data = &da9052_i2c_id[2] },
  62         { .compatible = "dlg,da9053-bb", .data = &da9052_i2c_id[3] },
  63         { /* sentinel */ }
  64 };
  65 #endif
  66
  67 static int __devinit da9052_i2c_probe(struct i2c_client *client,
  68                                        const struct i2c_device_id *id)
  69 {
  70         struct da9052 *da9052;
  71         int ret;
  72
  73         da9052 = devm_kzalloc(&client->dev, sizeof(struct da9052), GFP_KERNEL);
  74         if (!da9052)
  75                 return -ENOMEM;
  76
  77         if (!i2c_check_functionality(client->adapter,
  78                                      I2C_FUNC_SMBUS_BYTE_DATA)) {
  79                 dev_info(&client->dev, "Error in %s:i2c_check_functionality\n",
  80                          __func__);
  81                 return  -ENODEV;
  82         }
  83
  84         da9052->dev = &client->dev;
  85         da9052->chip_irq = client->irq;
  86
  87         i2c_set_clientdata(client, da9052);
  88
  89         da9052->regmap = devm_regmap_init_i2c(client, &da9052_regmap_config);
  90         if (IS_ERR(da9052->regmap)) {
  91                 ret = PTR_ERR(da9052->regmap);
  92                 dev_err(&client->dev, "Failed to allocate register map: %d\n",
  93                         ret);
  94                 return ret;
  95         }
  96
  97         ret = da9052_i2c_enable_multiwrite(da9052);
  98         if (ret < 0)
  99                 return ret;
 100
 101 #ifdef CONFIG_OF
 102         if (!id) {
 103                 struct device_node *np = client->dev.of_node;
 104                 const struct of_device_id *deviceid;
 105
 106                 deviceid = of_match_node(dialog_dt_ids, np);
 107                 id = (const struct i2c_device_id *)deviceid->data;
 108         }
 109 #endif
 110
 111         if (!id) {
 112                 ret = -ENODEV;
 113                 dev_err(&client->dev, "id is null.\n");
 114                 return ret;
 115         }
 116
 117         ret = da9052_device_init(da9052, id->driver_data);
 118         if (ret != 0)
 119                 return ret;
 120
 121         return 0;
 122 }
 123
 124 static int __devexit da9052_i2c_remove(struct i2c_client *client)
 125 {
 126         struct da9052 *da9052 = i2c_get_clientdata(client);
 127
 128         da9052_device_exit(da9052);
 129         return 0;
 130 }
 131
 132 static struct i2c_driver da9052_i2c_driver = {
 133         .probe = da9052_i2c_probe,
 134         .remove = __devexit_p(da9052_i2c_remove),
 135         .id_table = da9052_i2c_id,
 136         .driver = {
 137                 .name = "da9052",
 138                 .owner = THIS_MODULE,
 139 #ifdef CONFIG_OF
 140                 .of_match_table = dialog_dt_ids,
 141 #endif
 142         },
 143 };
 144
 145 static int __init da9052_i2c_init(void)
 146 {
 147         int ret;
 148
 149         ret = i2c_add_driver(&da9052_i2c_driver);
 150         if (ret != 0) {
 151                 pr_err("DA9052 I2C registration failed %d\n", ret);
 152                 return ret;
 153         }
 154
 155         return 0;
 156 }
 157 subsys_initcall(da9052_i2c_init);
 158
 159 static void __exit da9052_i2c_exit(void)
 160 {
 161         i2c_del_driver(&da9052_i2c_driver);
 162 }
 163 module_exit(da9052_i2c_exit);
 164
 165 MODULE_AUTHOR("David Dajun Chen <dchen@diasemi.com>");
 166 MODULE_DESCRIPTION("I2C driver for Dialog DA9052 PMIC");
 167 MODULE_LICENSE("GPL");