diff options
author | Jonathan Herman <hermanjl@cs.unc.edu> | 2013-01-22 10:38:37 -0500 |
---|---|---|
committer | Jonathan Herman <hermanjl@cs.unc.edu> | 2013-01-22 10:38:37 -0500 |
commit | fcc9d2e5a6c89d22b8b773a64fb4ad21ac318446 (patch) | |
tree | a57612d1888735a2ec7972891b68c1ac5ec8faea /drivers/regulator/fan53555-regulator.c | |
parent | 8dea78da5cee153b8af9c07a2745f6c55057fe12 (diff) |
Diffstat (limited to 'drivers/regulator/fan53555-regulator.c')
-rw-r--r-- | drivers/regulator/fan53555-regulator.c | 567 |
1 files changed, 567 insertions, 0 deletions
diff --git a/drivers/regulator/fan53555-regulator.c b/drivers/regulator/fan53555-regulator.c new file mode 100644 index 00000000000..13fa79c4ba3 --- /dev/null +++ b/drivers/regulator/fan53555-regulator.c | |||
@@ -0,0 +1,567 @@ | |||
1 | /* | ||
2 | * driver/regultor/fan53555-regulator.c | ||
3 | * | ||
4 | * Driver for FAN53555UC00X, FAN53555UC01X, FAN53555UC03X, | ||
5 | * FAN53555UC04X, FAN53555UC05X | ||
6 | * | ||
7 | * Copyright (c) 2011, NVIDIA Corporation. | ||
8 | * | ||
9 | * This program is free software; you can redistribute it and/or | ||
10 | * modify it under the terms of the GNU General Public License as | ||
11 | * published by the Free Software Foundation version 2. | ||
12 | * | ||
13 | * This program is distributed "as is" WITHOUT ANY WARRANTY of any kind, | ||
14 | * whether express or implied; without even the implied warranty of | ||
15 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU | ||
16 | * General Public License for more details. | ||
17 | * | ||
18 | * You should have received a copy of the GNU General Public License | ||
19 | * along with this program; if not, write to the Free Software | ||
20 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA | ||
21 | * 02111-1307, USA | ||
22 | */ | ||
23 | |||
24 | #include <linux/kernel.h> | ||
25 | #include <linux/module.h> | ||
26 | #include <linux/init.h> | ||
27 | #include <linux/err.h> | ||
28 | #include <linux/platform_device.h> | ||
29 | #include <linux/regulator/driver.h> | ||
30 | #include <linux/regulator/machine.h> | ||
31 | #include <linux/regulator/fan53555-regulator.h> | ||
32 | #include <linux/i2c.h> | ||
33 | #include <linux/delay.h> | ||
34 | #include <linux/slab.h> | ||
35 | |||
36 | /* Register definitions */ | ||
37 | #define FAN53555_REG_VSEL0 0 | ||
38 | #define FAN53555_REG_VSEL1 1 | ||
39 | #define FAN53555_REG_CONTROL 2 | ||
40 | #define FAN53555_REG_ID1 3 | ||
41 | #define FAN53555_REG_ID2 4 | ||
42 | #define FAN53555_REG_MONITOR 5 | ||
43 | |||
44 | #define FAN53555_VSEL_BUCK_EN BIT(7) | ||
45 | #define FAN53555_VSEL_MODE BIT(6) | ||
46 | #define FAN53555_VSEL_NSEL_SHIFT 0 | ||
47 | #define FAN53555_VSEL_NSEL_MASK 0x3F | ||
48 | |||
49 | #define FAN53555_CONTROL_DISCHARGE BIT(7) | ||
50 | #define FAN53555_CONTROL_SLEW_SHIFT 4 | ||
51 | #define FAN53555_CONTROL_SLEW_MASK 0x70 | ||
52 | #define FAN53555_CONTROL_RESET BIT(2) | ||
53 | |||
54 | #define FAN53555_ID1_VENDOR_SHIFT 4 | ||
55 | #define FAN53555_ID1_VENDOR_MASK 0xF0 | ||
56 | #define FAN53555_ID1_DIE_ID_SHIFT 0 | ||
57 | #define FAN53555_ID1_DIE_ID_MASK 0x0F | ||
58 | |||
59 | #define FAN53555_ID2_REV_SHIFT 0 | ||
60 | #define FAN53555_ID2_REV_MASK 0x0F | ||
61 | |||
62 | #define FAN53555_MONITOR_ILIM BIT(7) | ||
63 | #define FAN53555_MONITOR_UVLO BIT(6) | ||
64 | #define FAN53555_MONITOR_OVP BIT(5) | ||
65 | #define FAN53555_MONITOR_POS BIT(4) | ||
66 | #define FAN53555_MONITOR_NEG BIT(3) | ||
67 | #define FAN53555_MONITOR_RESET_STAT BIT(2) | ||
68 | #define FAN53555_MONITOR_OT BIT(1) | ||
69 | #define FAN53555_MONITOR_BUCK_STATUS BIT(0) | ||
70 | |||
71 | #define FAN53555_VSEL0_ID 0 | ||
72 | #define FAN53555_VSEL1_ID 1 | ||
73 | |||
74 | #define FAN53555UC00X_ID 0x80 | ||
75 | #define FAN53555UC01X_ID 0x81 | ||
76 | #define FAN53555UC03X_ID 0x83 | ||
77 | #define FAN53555UC04X_ID 0x84 | ||
78 | #define FAN53555UC05X_ID 0x85 | ||
79 | |||
80 | #define FAN53555_N_VOLTAGES 64 | ||
81 | |||
82 | /* FAN53555 chip information */ | ||
83 | struct fan53555_chip { | ||
84 | const char *name; | ||
85 | struct device *dev; | ||
86 | struct regulator_desc desc; | ||
87 | struct i2c_client *client; | ||
88 | struct regulator_dev *rdev; | ||
89 | struct mutex io_lock; | ||
90 | int chip_id; | ||
91 | int vsel_id; | ||
92 | u8 shadow[6]; | ||
93 | }; | ||
94 | |||
95 | #define FAN53555_VOLTAGE(chip_id, vsel) \ | ||
96 | (((chip_id) == FAN53555UC04X_ID) ? \ | ||
97 | ((vsel) * 12826 + 600000) : ((vsel) * 10000 + 600000)) | ||
98 | |||
99 | static int fan53555_read(struct fan53555_chip *fan, u8 reg) | ||
100 | { | ||
101 | u8 data; | ||
102 | u8 val; | ||
103 | int ret; | ||
104 | |||
105 | data = reg; | ||
106 | |||
107 | ret = i2c_master_send(fan->client, &data, 1); | ||
108 | if (ret < 0) | ||
109 | goto out; | ||
110 | |||
111 | ret = i2c_master_recv(fan->client, &val, 1); | ||
112 | if (ret < 0) | ||
113 | goto out; | ||
114 | |||
115 | ret = val; | ||
116 | out: | ||
117 | return ret; | ||
118 | } | ||
119 | |||
120 | static inline int fan53555_write(struct fan53555_chip *fan, u8 reg, u8 val) | ||
121 | { | ||
122 | u8 msg[2]; | ||
123 | int ret; | ||
124 | |||
125 | msg[0] = reg; | ||
126 | msg[1] = val; | ||
127 | |||
128 | ret = i2c_master_send(fan->client, msg, 2); | ||
129 | if (ret < 0) | ||
130 | return ret; | ||
131 | if (ret != 2) | ||
132 | return -EIO; | ||
133 | return 0; | ||
134 | } | ||
135 | |||
136 | static int fan53555_read_reg(struct fan53555_chip *fan, u8 reg) | ||
137 | { | ||
138 | int data; | ||
139 | |||
140 | mutex_lock(&fan->io_lock); | ||
141 | data = fan53555_read(fan, reg); | ||
142 | if (data < 0) | ||
143 | dev_err(fan->dev, "Read from reg 0x%x failed\n", reg); | ||
144 | mutex_unlock(&fan->io_lock); | ||
145 | |||
146 | return data; | ||
147 | } | ||
148 | |||
149 | static int fan53555_set_bits(struct fan53555_chip *fan, u8 reg, u8 mask, u8 val) | ||
150 | { | ||
151 | int err; | ||
152 | u8 data; | ||
153 | |||
154 | mutex_lock(&fan->io_lock); | ||
155 | data = fan->shadow[reg]; | ||
156 | data &= ~mask; | ||
157 | val &= mask; | ||
158 | data |= val; | ||
159 | err = fan53555_write(fan, reg, data); | ||
160 | if (err) | ||
161 | dev_err(fan->dev, "write for reg 0x%x failed\n", reg); | ||
162 | else | ||
163 | fan->shadow[reg] = data; | ||
164 | mutex_unlock(&fan->io_lock); | ||
165 | |||
166 | return err; | ||
167 | } | ||
168 | |||
169 | static int __fan53555_dcdc_set_voltage(struct fan53555_chip *fan, | ||
170 | int vsel_id, int min_uV, int max_uV, | ||
171 | unsigned *selector) | ||
172 | { | ||
173 | int nsel; | ||
174 | int uV; | ||
175 | int chip_id; | ||
176 | int n_voltages; | ||
177 | |||
178 | chip_id = fan->chip_id; | ||
179 | n_voltages = fan->desc.n_voltages; | ||
180 | |||
181 | if (max_uV < min_uV) { | ||
182 | dev_err(fan->dev, "max_uV(%d) < min_uV(%d)\n", max_uV, min_uV); | ||
183 | return -EINVAL; | ||
184 | } | ||
185 | if (min_uV > FAN53555_VOLTAGE(chip_id, n_voltages - 1)) { | ||
186 | dev_err(fan->dev, "min_uV(%d) > %d[uV]\n", | ||
187 | min_uV, FAN53555_VOLTAGE(chip_id, n_voltages - 1)); | ||
188 | return -EINVAL; | ||
189 | } | ||
190 | if (max_uV < FAN53555_VOLTAGE(chip_id, 0)) { | ||
191 | dev_err(fan->dev, "max_uV(%d) < %d[uV]\n", | ||
192 | max_uV, FAN53555_VOLTAGE(chip_id, 0)); | ||
193 | return -EINVAL; | ||
194 | } | ||
195 | if ((vsel_id != FAN53555_VSEL0_ID) && (vsel_id != FAN53555_VSEL1_ID)) { | ||
196 | dev_err(fan->dev, | ||
197 | "%d is not valid VSEL register ID\n", vsel_id); | ||
198 | return -EINVAL; | ||
199 | } | ||
200 | for (nsel = 0; nsel < n_voltages; nsel++) { | ||
201 | uV = FAN53555_VOLTAGE(chip_id, nsel); | ||
202 | if (min_uV <= uV && uV <= max_uV) { | ||
203 | if (selector) | ||
204 | *selector = nsel; | ||
205 | return fan53555_set_bits(fan, | ||
206 | FAN53555_REG_VSEL0 + vsel_id, | ||
207 | FAN53555_VSEL_NSEL_MASK, | ||
208 | nsel << | ||
209 | FAN53555_VSEL_NSEL_SHIFT); | ||
210 | } | ||
211 | } | ||
212 | |||
213 | return -EINVAL; | ||
214 | } | ||
215 | |||
216 | #ifdef CONFIG_DEBUG_FS | ||
217 | |||
218 | #include <linux/debugfs.h> | ||
219 | #include <linux/seq_file.h> | ||
220 | |||
221 | static int dbg_fan_show(struct seq_file *s, void *unused) | ||
222 | { | ||
223 | struct fan53555_chip *fan = s->private; | ||
224 | int val; | ||
225 | |||
226 | seq_printf(s, "FAN53555 Registers\n"); | ||
227 | seq_printf(s, "------------------\n"); | ||
228 | |||
229 | val = fan53555_read_reg(fan, FAN53555_REG_VSEL0); | ||
230 | if (val >= 0) | ||
231 | seq_printf(s, "Reg VSEL0 Value 0x%02x\n", val); | ||
232 | |||
233 | val = fan53555_read_reg(fan, FAN53555_REG_VSEL1); | ||
234 | if (val >= 0) | ||
235 | seq_printf(s, "Reg VSEL1 Value 0x%02x\n", val); | ||
236 | |||
237 | val = fan53555_read_reg(fan, FAN53555_REG_CONTROL); | ||
238 | if (val >= 0) | ||
239 | seq_printf(s, "Reg CONTROL Value 0x%02x\n", val); | ||
240 | |||
241 | val = fan53555_read_reg(fan, FAN53555_REG_ID1); | ||
242 | if (val >= 0) | ||
243 | seq_printf(s, "Reg ID1 Value 0x%02x\n", val); | ||
244 | |||
245 | val = fan53555_read_reg(fan, FAN53555_REG_ID2); | ||
246 | if (val >= 0) | ||
247 | seq_printf(s, "Reg ID2 Value 0x%02x\n", val); | ||
248 | |||
249 | val = fan53555_read_reg(fan, FAN53555_REG_MONITOR); | ||
250 | if (val >= 0) | ||
251 | seq_printf(s, "Reg MONITOR Value 0x%02x\n", val); | ||
252 | |||
253 | return 0; | ||
254 | } | ||
255 | |||
256 | static int dbg_fan_open(struct inode *inode, struct file *file) | ||
257 | { | ||
258 | return single_open(file, dbg_fan_show, inode->i_private); | ||
259 | } | ||
260 | |||
261 | static const struct file_operations debug_fops = { | ||
262 | .open = dbg_fan_open, | ||
263 | .read = seq_read, | ||
264 | .llseek = seq_lseek, | ||
265 | .release = single_release, | ||
266 | }; | ||
267 | |||
268 | static void __init fan53555_debuginit(struct fan53555_chip *fan) | ||
269 | { | ||
270 | (void)debugfs_create_file("fan53555", S_IRUGO, NULL, fan, &debug_fops); | ||
271 | } | ||
272 | #else | ||
273 | static void __init fan53555_debuginit(struct fan53555_chip *fan) | ||
274 | { | ||
275 | } | ||
276 | #endif | ||
277 | |||
278 | static int fan53555_dcdc_init(struct fan53555_chip *fan, | ||
279 | struct i2c_client *client, | ||
280 | struct fan53555_regulator_platform_data *pdata) | ||
281 | { | ||
282 | int err; | ||
283 | int val; | ||
284 | |||
285 | err = fan53555_read_reg(fan, FAN53555_REG_VSEL0); | ||
286 | if (err < 0) | ||
287 | return err; | ||
288 | fan->shadow[FAN53555_REG_VSEL0] = (u8)err; | ||
289 | |||
290 | err = fan53555_read_reg(fan, FAN53555_REG_VSEL1); | ||
291 | if (err < 0) | ||
292 | return err; | ||
293 | fan->shadow[FAN53555_REG_VSEL1] = (u8)err; | ||
294 | |||
295 | err = fan53555_read_reg(fan, FAN53555_REG_CONTROL); | ||
296 | if (err < 0) | ||
297 | return err; | ||
298 | fan->shadow[FAN53555_REG_CONTROL] = (u8)err; | ||
299 | |||
300 | err = __fan53555_dcdc_set_voltage(fan, | ||
301 | FAN53555_VSEL0_ID, | ||
302 | pdata->init_vsel0_min_uV, | ||
303 | pdata->init_vsel0_max_uV, | ||
304 | NULL); | ||
305 | if (err < 0) | ||
306 | return err; | ||
307 | |||
308 | val = pdata->vsel0_buck_en ? FAN53555_VSEL_BUCK_EN : 0; | ||
309 | val |= pdata->vsel0_mode ? FAN53555_VSEL_MODE : 0; | ||
310 | err = fan53555_set_bits(fan, | ||
311 | FAN53555_REG_VSEL0, | ||
312 | FAN53555_VSEL_BUCK_EN | FAN53555_VSEL_MODE, | ||
313 | val); | ||
314 | if (err < 0) | ||
315 | return err; | ||
316 | |||
317 | err = __fan53555_dcdc_set_voltage(fan, | ||
318 | FAN53555_VSEL1_ID, | ||
319 | pdata->init_vsel1_min_uV, | ||
320 | pdata->init_vsel1_max_uV, | ||
321 | NULL); | ||
322 | if (err < 0) | ||
323 | return err; | ||
324 | |||
325 | val = pdata->vsel1_buck_en ? FAN53555_VSEL_BUCK_EN : 0; | ||
326 | val |= pdata->vsel1_mode ? FAN53555_VSEL_MODE : 0; | ||
327 | err = fan53555_set_bits(fan, | ||
328 | FAN53555_REG_VSEL1, | ||
329 | FAN53555_VSEL_BUCK_EN | FAN53555_VSEL_MODE, | ||
330 | val); | ||
331 | if (err < 0) | ||
332 | return err; | ||
333 | |||
334 | val = pdata->slew_rate; | ||
335 | val <<= FAN53555_CONTROL_SLEW_SHIFT; | ||
336 | val |= pdata->output_discharge ? FAN53555_CONTROL_DISCHARGE : 0; | ||
337 | err = fan53555_set_bits(fan, | ||
338 | FAN53555_REG_CONTROL, | ||
339 | FAN53555_CONTROL_DISCHARGE | | ||
340 | FAN53555_CONTROL_SLEW_MASK, val); | ||
341 | return err; | ||
342 | } | ||
343 | |||
344 | static int fan53555_dcdc_list_voltage(struct regulator_dev *dev, | ||
345 | unsigned selector) | ||
346 | { | ||
347 | struct fan53555_chip *fan = rdev_get_drvdata(dev); | ||
348 | |||
349 | if ((selector < 0) || (selector >= fan->desc.n_voltages)) | ||
350 | return -EINVAL; | ||
351 | |||
352 | return FAN53555_VOLTAGE(fan->chip_id, selector); | ||
353 | } | ||
354 | |||
355 | static int fan53555_dcdc_set_voltage(struct regulator_dev *dev, | ||
356 | int min_uV, int max_uV, | ||
357 | unsigned *selector) | ||
358 | { | ||
359 | struct fan53555_chip *fan = rdev_get_drvdata(dev); | ||
360 | |||
361 | return __fan53555_dcdc_set_voltage(fan, fan->vsel_id, min_uV, max_uV, | ||
362 | selector); | ||
363 | } | ||
364 | |||
365 | static int fan53555_dcdc_get_voltage(struct regulator_dev *dev) | ||
366 | { | ||
367 | struct fan53555_chip *fan = rdev_get_drvdata(dev); | ||
368 | u8 data; | ||
369 | |||
370 | if ((fan->vsel_id != FAN53555_VSEL0_ID) && | ||
371 | (fan->vsel_id != FAN53555_VSEL1_ID)) { | ||
372 | dev_err(fan->dev, | ||
373 | "%d is not valid VSEL register ID\n", fan->vsel_id); | ||
374 | return -EINVAL; | ||
375 | } | ||
376 | data = fan->shadow[FAN53555_REG_VSEL0 + fan->vsel_id]; | ||
377 | data &= FAN53555_VSEL_NSEL_MASK; | ||
378 | data >>= FAN53555_VSEL_NSEL_SHIFT; | ||
379 | |||
380 | return FAN53555_VOLTAGE(fan->chip_id, data); | ||
381 | } | ||
382 | |||
383 | static int fan53555_dcdc_enable(struct regulator_dev *dev) | ||
384 | { | ||
385 | struct fan53555_chip *fan = rdev_get_drvdata(dev); | ||
386 | |||
387 | if ((fan->vsel_id != FAN53555_VSEL0_ID) && | ||
388 | (fan->vsel_id != FAN53555_VSEL1_ID)) { | ||
389 | dev_err(fan->dev, | ||
390 | "%d is not valid VSEL register ID\n", fan->vsel_id); | ||
391 | return -EINVAL; | ||
392 | } | ||
393 | |||
394 | return fan53555_set_bits(fan, | ||
395 | FAN53555_REG_VSEL0 + fan->vsel_id, | ||
396 | FAN53555_VSEL_BUCK_EN, FAN53555_VSEL_BUCK_EN); | ||
397 | } | ||
398 | |||
399 | static int fan53555_dcdc_disable(struct regulator_dev *dev) | ||
400 | { | ||
401 | struct fan53555_chip *fan = rdev_get_drvdata(dev); | ||
402 | |||
403 | if ((fan->vsel_id != FAN53555_VSEL0_ID) && | ||
404 | (fan->vsel_id != FAN53555_VSEL1_ID)) { | ||
405 | dev_err(fan->dev, | ||
406 | "%d is not valid VSEL register ID\n", fan->vsel_id); | ||
407 | return -EINVAL; | ||
408 | } | ||
409 | |||
410 | return fan53555_set_bits(fan, | ||
411 | FAN53555_REG_VSEL0 + fan->vsel_id, | ||
412 | FAN53555_VSEL_BUCK_EN, 0); | ||
413 | } | ||
414 | |||
415 | static int fan53555_dcdc_is_enabled(struct regulator_dev *dev) | ||
416 | { | ||
417 | struct fan53555_chip *fan = rdev_get_drvdata(dev); | ||
418 | u8 data; | ||
419 | |||
420 | if ((fan->vsel_id != FAN53555_VSEL0_ID) && | ||
421 | (fan->vsel_id != FAN53555_VSEL1_ID)) { | ||
422 | dev_err(fan->dev, | ||
423 | "%d is not valid VSEL register ID\n", fan->vsel_id); | ||
424 | return -EINVAL; | ||
425 | } | ||
426 | data = fan->shadow[FAN53555_REG_VSEL0 + fan->vsel_id]; | ||
427 | |||
428 | return (data & FAN53555_VSEL_BUCK_EN) ? 1 : 0; | ||
429 | } | ||
430 | |||
431 | static struct regulator_ops fan53555_dcdc_ops = { | ||
432 | .list_voltage = fan53555_dcdc_list_voltage, | ||
433 | .set_voltage = fan53555_dcdc_set_voltage, | ||
434 | .get_voltage = fan53555_dcdc_get_voltage, | ||
435 | .enable = fan53555_dcdc_enable, | ||
436 | .disable = fan53555_dcdc_disable, | ||
437 | .is_enabled = fan53555_dcdc_is_enabled, | ||
438 | }; | ||
439 | |||
440 | static int __devinit fan53555_probe(struct i2c_client *client, | ||
441 | const struct i2c_device_id *id) | ||
442 | { | ||
443 | struct fan53555_regulator_platform_data *pdata; | ||
444 | struct regulator_init_data *init_data; | ||
445 | struct regulator_dev *rdev; | ||
446 | struct fan53555_chip *fan; | ||
447 | int chip_id; | ||
448 | int err; | ||
449 | |||
450 | pdata = client->dev.platform_data; | ||
451 | if (!pdata) { | ||
452 | dev_err(&client->dev, "Err: Platform data not found\n"); | ||
453 | return -EIO; | ||
454 | } | ||
455 | init_data = &pdata->reg_init_data; | ||
456 | fan = kzalloc(sizeof(*fan), GFP_KERNEL); | ||
457 | if (!fan) { | ||
458 | dev_err(&client->dev, "Err: Memory allocation fails\n"); | ||
459 | return -ENOMEM; | ||
460 | } | ||
461 | mutex_init(&fan->io_lock); | ||
462 | fan->client = client; | ||
463 | fan->dev = &client->dev; | ||
464 | fan->vsel_id = pdata->vsel_id; | ||
465 | fan->name = id->name; | ||
466 | fan->desc.name = id->name; | ||
467 | fan->desc.id = 0; | ||
468 | fan->desc.irq = 0; | ||
469 | fan->desc.ops = &fan53555_dcdc_ops; | ||
470 | fan->desc.type = REGULATOR_VOLTAGE; | ||
471 | fan->desc.owner = THIS_MODULE; | ||
472 | fan->desc.n_voltages = FAN53555_N_VOLTAGES; | ||
473 | i2c_set_clientdata(client, fan); | ||
474 | |||
475 | chip_id = fan53555_read_reg(fan, FAN53555_REG_ID1); | ||
476 | if (chip_id < 0) { | ||
477 | err = chip_id; | ||
478 | dev_err(fan->dev, "Error in reading device %d\n", err); | ||
479 | goto fail; | ||
480 | } | ||
481 | |||
482 | switch (chip_id) { | ||
483 | case FAN53555UC00X_ID: | ||
484 | case FAN53555UC01X_ID: | ||
485 | case FAN53555UC03X_ID: | ||
486 | case FAN53555UC04X_ID: | ||
487 | case FAN53555UC05X_ID: | ||
488 | fan->chip_id = chip_id; | ||
489 | break; | ||
490 | default: | ||
491 | dev_err(fan->dev, "Err: not supported device chip id 0x%x", | ||
492 | chip_id); | ||
493 | err = -ENODEV; | ||
494 | goto fail; | ||
495 | } | ||
496 | |||
497 | err = fan53555_dcdc_init(fan, client, pdata); | ||
498 | if (err < 0) { | ||
499 | dev_err(fan->dev, "FAN53555 init fails with %d\n", err); | ||
500 | goto fail; | ||
501 | } | ||
502 | |||
503 | rdev = regulator_register(&fan->desc, &client->dev, init_data, fan); | ||
504 | if (IS_ERR(rdev)) { | ||
505 | dev_err(fan->dev, "Failed to register %s\n", id->name); | ||
506 | err = PTR_ERR(rdev); | ||
507 | goto fail; | ||
508 | } | ||
509 | fan->rdev = rdev; | ||
510 | |||
511 | fan53555_debuginit(fan); | ||
512 | return 0; | ||
513 | |||
514 | fail: | ||
515 | kfree(fan); | ||
516 | return err; | ||
517 | } | ||
518 | |||
519 | /** | ||
520 | * fan53555_remove - fan53555 driver i2c remove handler | ||
521 | * @client: i2c driver client device structure | ||
522 | * | ||
523 | * Unregister fan53555 driver as an i2c client device driver | ||
524 | */ | ||
525 | static int __devexit fan53555_remove(struct i2c_client *client) | ||
526 | { | ||
527 | struct fan53555_chip *chip = i2c_get_clientdata(client); | ||
528 | |||
529 | regulator_unregister(chip->rdev); | ||
530 | kfree(chip); | ||
531 | return 0; | ||
532 | } | ||
533 | |||
534 | static const struct i2c_device_id fan53555_id[] = { | ||
535 | {.name = "fan53555", .driver_data = 0 }, | ||
536 | {}, | ||
537 | }; | ||
538 | MODULE_DEVICE_TABLE(i2c, fan53555_id); | ||
539 | |||
540 | static struct i2c_driver fan53555_i2c_driver = { | ||
541 | .driver = { | ||
542 | .name = "fan53555", | ||
543 | .owner = THIS_MODULE, | ||
544 | }, | ||
545 | .probe = fan53555_probe, | ||
546 | .remove = __devexit_p(fan53555_remove), | ||
547 | .id_table = fan53555_id, | ||
548 | }; | ||
549 | |||
550 | /* Module init function */ | ||
551 | static int __init fan53555_init(void) | ||
552 | { | ||
553 | return i2c_add_driver(&fan53555_i2c_driver); | ||
554 | } | ||
555 | subsys_initcall_sync(fan53555_init); | ||
556 | |||
557 | /* Module exit function */ | ||
558 | static void __exit fan53555_cleanup(void) | ||
559 | { | ||
560 | i2c_del_driver(&fan53555_i2c_driver); | ||
561 | } | ||
562 | module_exit(fan53555_cleanup); | ||
563 | |||
564 | MODULE_LICENSE("GPL"); | ||
565 | MODULE_AUTHOR("Jake Park<jakep@nvidia.com>"); | ||
566 | MODULE_DESCRIPTION("Regulator Driver for Fairchild FAN53555 Regulator"); | ||
567 | MODULE_ALIAS("platform:fan53555-regulator"); | ||