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 = kzalloc(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                 ret = -ENODEV;
  82                 goto err;
  83         }
  84
  85         da9052->dev = &client->dev;
  86         da9052->chip_irq = client->irq;
  87
  88         i2c_set_clientdata(client, da9052);
  89
  90         da9052->regmap = regmap_init_i2c(client, &da9052_regmap_config);
  91         if (IS_ERR(da9052->regmap)) {
  92                 ret = PTR_ERR(da9052->regmap);
  93                 dev_err(&client->dev, "Failed to allocate register map: %d\n",
  94                         ret);
  95                 goto err;
  96         }
  97
  98         ret = da9052_i2c_enable_multiwrite(da9052);
  99         if (ret < 0)
 100                 goto err_regmap;
 101
 102 #ifdef CONFIG_OF
 103         if (!id) {
 104                 struct device_node *np = client->dev.of_node;
 105                 const struct of_device_id *deviceid;
 106
 107                 deviceid = of_match_node(np, dialog_dt_ids);
 108                 id = (const struct i2c_device_id *)deviceid->data;
 109         }
 110 #endif
 111
 112         if (!id) {
 113                 ret = -ENODEV;
 114                 dev_err(&client->dev, "id is null.\n");
 115                 goto err_regmap;
 116         }
 117
 118         ret = da9052_device_init(da9052, id->driver_data);
 119         if (ret != 0)
 120                 goto err_regmap;
 121
 122         return 0;
 123
 124 err_regmap:
 125         regmap_exit(da9052->regmap);
 126 err:
 127         kfree(da9052);
 128         return ret;
 129 }
 130
 131 static int __devexit da9052_i2c_remove(struct i2c_client *client)
 132 {
 133         struct da9052 *da9052 = i2c_get_clientdata(client);
 134
 135         da9052_device_exit(da9052);
 136         regmap_exit(da9052->regmap);
 137         kfree(da9052);
 138
 139         return 0;
 140 }
 141
 142 static struct i2c_driver da9052_i2c_driver = {
 143         .probe = da9052_i2c_probe,
 144         .remove = __devexit_p(da9052_i2c_remove),
 145         .id_table = da9052_i2c_id,
 146         .driver = {
 147                 .name = "da9052",
 148                 .owner = THIS_MODULE,
 149 #ifdef CONFIG_OF
 150                 .of_match_table = dialog_dt_ids,
 151 #endif
 152         },
 153 };
 154
 155 static int __init da9052_i2c_init(void)
 156 {
 157         int ret;
 158
 159         ret = i2c_add_driver(&da9052_i2c_driver);
 160         if (ret != 0) {
 161                 pr_err("DA9052 I2C registration failed %d\n", ret);
 162                 return ret;
 163         }
 164
 165         return 0;
 166 }
 167 subsys_initcall(da9052_i2c_init);
 168
 169 static void __exit da9052_i2c_exit(void)
 170 {
 171         i2c_del_driver(&da9052_i2c_driver);
 172 }
 173 module_exit(da9052_i2c_exit);
 174
 175 MODULE_AUTHOR("David Dajun Chen <dchen@diasemi.com>");
 176 MODULE_DESCRIPTION("I2C driver for Dialog DA9052 PMIC");
 177 MODULE_LICENSE("GPL");