ac74a4d1daead1848ef00e9ac096013d69e67a21
[~shefty/rdma-dev.git] / 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 const 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 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 = 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 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 = 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");