Blame view

drivers/regulator/tps6524x-regulator.c 14.7 KB
1394fd282   Cyril Chemparathy   regulator: add dr...
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
  /*
   * Regulator driver for TPS6524x PMIC
   *
   * Copyright (C) 2010 Texas Instruments
   *
   * This program is free software; you can redistribute it and/or
   * modify it under the terms of the GNU General Public License as
   * published by the Free Software Foundation version 2.
   *
   * This program is distributed "as is" WITHOUT ANY WARRANTY of any kind,
   * whether express or implied; without even the implied warranty of
   * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
   * General Public License for more details.
   */
  
  #include <linux/kernel.h>
  #include <linux/module.h>
  #include <linux/err.h>
  #include <linux/errno.h>
  #include <linux/slab.h>
  #include <linux/spi/spi.h>
  #include <linux/regulator/driver.h>
  #include <linux/regulator/machine.h>
  
  #define REG_LDO_SET		0x0
  #define LDO_ILIM_MASK		1	/* 0 = 400-800, 1 = 900-1500 */
  #define LDO_VSEL_MASK		0x0f
  #define LDO2_ILIM_SHIFT		12
  #define LDO2_VSEL_SHIFT		4
  #define LDO1_ILIM_SHIFT		8
  #define LDO1_VSEL_SHIFT		0
  
  #define REG_BLOCK_EN		0x1
  #define BLOCK_MASK		1
  #define BLOCK_LDO1_SHIFT	0
  #define BLOCK_LDO2_SHIFT	1
  #define BLOCK_LCD_SHIFT		2
  #define BLOCK_USB_SHIFT		3
  
  #define REG_DCDC_SET		0x2
  #define DCDC_VDCDC_MASK		0x1f
  #define DCDC_VDCDC1_SHIFT	0
  #define DCDC_VDCDC2_SHIFT	5
  #define DCDC_VDCDC3_SHIFT	10
  
  #define REG_DCDC_EN		0x3
  #define DCDCDCDC_EN_MASK	0x1
  #define DCDCDCDC1_EN_SHIFT	0
  #define DCDCDCDC1_PG_MSK	BIT(1)
  #define DCDCDCDC2_EN_SHIFT	2
  #define DCDCDCDC2_PG_MSK	BIT(3)
  #define DCDCDCDC3_EN_SHIFT	4
  #define DCDCDCDC3_PG_MSK	BIT(5)
  
  #define REG_USB			0x4
  #define USB_ILIM_SHIFT		0
  #define USB_ILIM_MASK		0x3
  #define USB_TSD_SHIFT		2
  #define USB_TSD_MASK		0x3
  #define USB_TWARN_SHIFT		4
  #define USB_TWARN_MASK		0x3
  #define USB_IWARN_SD		BIT(6)
  #define USB_FAST_LOOP		BIT(7)
  
  #define REG_ALARM		0x5
  #define ALARM_LDO1		BIT(0)
  #define ALARM_DCDC1		BIT(1)
  #define ALARM_DCDC2		BIT(2)
  #define ALARM_DCDC3		BIT(3)
  #define ALARM_LDO2		BIT(4)
  #define ALARM_USB_WARN		BIT(5)
  #define ALARM_USB_ALARM		BIT(6)
  #define ALARM_LCD		BIT(9)
  #define ALARM_TEMP_WARM		BIT(10)
  #define ALARM_TEMP_HOT		BIT(11)
  #define ALARM_NRST		BIT(14)
  #define ALARM_POWERUP		BIT(15)
  
  #define REG_INT_ENABLE		0x6
  #define INT_LDO1		BIT(0)
  #define INT_DCDC1		BIT(1)
  #define INT_DCDC2		BIT(2)
  #define INT_DCDC3		BIT(3)
  #define INT_LDO2		BIT(4)
  #define INT_USB_WARN		BIT(5)
  #define INT_USB_ALARM		BIT(6)
  #define INT_LCD			BIT(9)
  #define INT_TEMP_WARM		BIT(10)
  #define INT_TEMP_HOT		BIT(11)
  #define INT_GLOBAL_EN		BIT(15)
  
  #define REG_INT_STATUS		0x7
  #define STATUS_LDO1		BIT(0)
  #define STATUS_DCDC1		BIT(1)
  #define STATUS_DCDC2		BIT(2)
  #define STATUS_DCDC3		BIT(3)
  #define STATUS_LDO2		BIT(4)
  #define STATUS_USB_WARN		BIT(5)
  #define STATUS_USB_ALARM	BIT(6)
  #define STATUS_LCD		BIT(9)
  #define STATUS_TEMP_WARM	BIT(10)
  #define STATUS_TEMP_HOT		BIT(11)
  
  #define REG_SOFTWARE_RESET	0xb
  #define REG_WRITE_ENABLE	0xd
  #define REG_REV_ID		0xf
  
  #define N_DCDC			3
  #define N_LDO			2
  #define N_SWITCH		2
4d984d1cd   Axel Lin   regulator: tps652...
111
  #define N_REGULATORS		(N_DCDC + N_LDO + N_SWITCH)
1394fd282   Cyril Chemparathy   regulator: add dr...
112

1394fd282   Cyril Chemparathy   regulator: add dr...
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
  #define CMD_READ(reg)		((reg) << 6)
  #define CMD_WRITE(reg)		(BIT(5) | (reg) << 6)
  #define STAT_CLK		BIT(3)
  #define STAT_WRITE		BIT(2)
  #define STAT_INVALID		BIT(1)
  #define STAT_WP			BIT(0)
  
  struct field {
  	int		reg;
  	int		shift;
  	int		mask;
  };
  
  struct supply_info {
  	const char	*name;
  	int		n_voltages;
cac87fd34   Axel Lin   regulator: tps652...
129
  	const unsigned int *voltages;
1394fd282   Cyril Chemparathy   regulator: add dr...
130
  	int		n_ilimsels;
1e12dfc96   Axel Lin   regulator: tps652...
131
  	const unsigned int *ilimsels;
1394fd282   Cyril Chemparathy   regulator: add dr...
132
133
134
135
136
137
138
139
  	struct field	enable, voltage, ilimsel;
  };
  
  struct tps6524x {
  	struct device		*dev;
  	struct spi_device	*spi;
  	struct mutex		lock;
  	struct regulator_desc	desc[N_REGULATORS];
1394fd282   Cyril Chemparathy   regulator: add dr...
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
302
303
304
305
306
  };
  
  static int __read_reg(struct tps6524x *hw, int reg)
  {
  	int error = 0;
  	u16 cmd = CMD_READ(reg), in;
  	u8 status;
  	struct spi_message m;
  	struct spi_transfer t[3];
  
  	spi_message_init(&m);
  	memset(t, 0, sizeof(t));
  
  	t[0].tx_buf = &cmd;
  	t[0].len = 2;
  	t[0].bits_per_word = 12;
  	spi_message_add_tail(&t[0], &m);
  
  	t[1].rx_buf = &in;
  	t[1].len = 2;
  	t[1].bits_per_word = 16;
  	spi_message_add_tail(&t[1], &m);
  
  	t[2].rx_buf = &status;
  	t[2].len = 1;
  	t[2].bits_per_word = 4;
  	spi_message_add_tail(&t[2], &m);
  
  	error = spi_sync(hw->spi, &m);
  	if (error < 0)
  		return error;
  
  	dev_dbg(hw->dev, "read reg %d, data %x, status %x
  ",
  		reg, in, status);
  
  	if (!(status & STAT_CLK) || (status & STAT_WRITE))
  		return -EIO;
  
  	if (status & STAT_INVALID)
  		return -EINVAL;
  
  	return in;
  }
  
  static int read_reg(struct tps6524x *hw, int reg)
  {
  	int ret;
  
  	mutex_lock(&hw->lock);
  	ret = __read_reg(hw, reg);
  	mutex_unlock(&hw->lock);
  
  	return ret;
  }
  
  static int __write_reg(struct tps6524x *hw, int reg, int val)
  {
  	int error = 0;
  	u16 cmd = CMD_WRITE(reg), out = val;
  	u8 status;
  	struct spi_message m;
  	struct spi_transfer t[3];
  
  	spi_message_init(&m);
  	memset(t, 0, sizeof(t));
  
  	t[0].tx_buf = &cmd;
  	t[0].len = 2;
  	t[0].bits_per_word = 12;
  	spi_message_add_tail(&t[0], &m);
  
  	t[1].tx_buf = &out;
  	t[1].len = 2;
  	t[1].bits_per_word = 16;
  	spi_message_add_tail(&t[1], &m);
  
  	t[2].rx_buf = &status;
  	t[2].len = 1;
  	t[2].bits_per_word = 4;
  	spi_message_add_tail(&t[2], &m);
  
  	error = spi_sync(hw->spi, &m);
  	if (error < 0)
  		return error;
  
  	dev_dbg(hw->dev, "wrote reg %d, data %x, status %x
  ",
  		reg, out, status);
  
  	if (!(status & STAT_CLK) || !(status & STAT_WRITE))
  		return -EIO;
  
  	if (status & (STAT_INVALID | STAT_WP))
  		return -EINVAL;
  
  	return error;
  }
  
  static int __rmw_reg(struct tps6524x *hw, int reg, int mask, int val)
  {
  	int ret;
  
  	ret = __read_reg(hw, reg);
  	if (ret < 0)
  		return ret;
  
  	ret &= ~mask;
  	ret |= val;
  
  	ret = __write_reg(hw, reg, ret);
  
  	return (ret < 0) ? ret : 0;
  }
  
  static int rmw_protect(struct tps6524x *hw, int reg, int mask, int val)
  {
  	int ret;
  
  	mutex_lock(&hw->lock);
  
  	ret = __write_reg(hw, REG_WRITE_ENABLE, 1);
  	if (ret) {
  		dev_err(hw->dev, "failed to set write enable
  ");
  		goto error;
  	}
  
  	ret = __rmw_reg(hw, reg, mask, val);
  	if (ret)
  		dev_err(hw->dev, "failed to rmw register %d
  ", reg);
  
  	ret = __write_reg(hw, REG_WRITE_ENABLE, 0);
  	if (ret) {
  		dev_err(hw->dev, "failed to clear write enable
  ");
  		goto error;
  	}
  
  error:
  	mutex_unlock(&hw->lock);
  
  	return ret;
  }
  
  static int read_field(struct tps6524x *hw, const struct field *field)
  {
  	int tmp;
  
  	tmp = read_reg(hw, field->reg);
  	if (tmp < 0)
  		return tmp;
  
  	return (tmp >> field->shift) & field->mask;
  }
  
  static int write_field(struct tps6524x *hw, const struct field *field,
  		       int val)
  {
  	if (val & ~field->mask)
  		return -EOVERFLOW;
  
  	return rmw_protect(hw, field->reg,
  				    field->mask << field->shift,
  				    val << field->shift);
  }
cac87fd34   Axel Lin   regulator: tps652...
307
  static const unsigned int dcdc1_voltages[] = {
1394fd282   Cyril Chemparathy   regulator: add dr...
308
309
310
311
312
313
314
315
316
  	 800000,  825000,  850000,  875000,
  	 900000,  925000,  950000,  975000,
  	1000000, 1025000, 1050000, 1075000,
  	1100000, 1125000, 1150000, 1175000,
  	1200000, 1225000, 1250000, 1275000,
  	1300000, 1325000, 1350000, 1375000,
  	1400000, 1425000, 1450000, 1475000,
  	1500000, 1525000, 1550000, 1575000,
  };
cac87fd34   Axel Lin   regulator: tps652...
317
  static const unsigned int dcdc2_voltages[] = {
1394fd282   Cyril Chemparathy   regulator: add dr...
318
319
320
321
322
323
324
325
326
  	1400000, 1450000, 1500000, 1550000,
  	1600000, 1650000, 1700000, 1750000,
  	1800000, 1850000, 1900000, 1950000,
  	2000000, 2050000, 2100000, 2150000,
  	2200000, 2250000, 2300000, 2350000,
  	2400000, 2450000, 2500000, 2550000,
  	2600000, 2650000, 2700000, 2750000,
  	2800000, 2850000, 2900000, 2950000,
  };
cac87fd34   Axel Lin   regulator: tps652...
327
  static const unsigned int dcdc3_voltages[] = {
1394fd282   Cyril Chemparathy   regulator: add dr...
328
329
330
331
332
333
  	2400000, 2450000, 2500000, 2550000, 2600000,
  	2650000, 2700000, 2750000, 2800000, 2850000,
  	2900000, 2950000, 3000000, 3050000, 3100000,
  	3150000, 3200000, 3250000, 3300000, 3350000,
  	3400000, 3450000, 3500000, 3550000, 3600000,
  };
cac87fd34   Axel Lin   regulator: tps652...
334
  static const unsigned int ldo1_voltages[] = {
1394fd282   Cyril Chemparathy   regulator: add dr...
335
336
337
338
339
  	4300000, 4350000, 4400000, 4450000,
  	4500000, 4550000, 4600000, 4650000,
  	4700000, 4750000, 4800000, 4850000,
  	4900000, 4950000, 5000000, 5050000,
  };
cac87fd34   Axel Lin   regulator: tps652...
340
  static const unsigned int ldo2_voltages[] = {
1394fd282   Cyril Chemparathy   regulator: add dr...
341
342
343
344
345
  	1100000, 1150000, 1200000, 1250000,
  	1300000, 1700000, 1750000, 1800000,
  	1850000, 1900000, 3150000, 3200000,
  	3250000, 3300000, 3350000, 3400000,
  };
cac87fd34   Axel Lin   regulator: tps652...
346
347
348
  static const unsigned int fixed_5000000_voltage[] = {
  	5000000
  };
1e12dfc96   Axel Lin   regulator: tps652...
349
  static const unsigned int ldo_ilimsel[] = {
1394fd282   Cyril Chemparathy   regulator: add dr...
350
351
  	400000, 1500000
  };
1e12dfc96   Axel Lin   regulator: tps652...
352
  static const unsigned int usb_ilimsel[] = {
1394fd282   Cyril Chemparathy   regulator: add dr...
353
354
  	200000, 400000, 800000, 1000000
  };
1e12dfc96   Axel Lin   regulator: tps652...
355
356
357
358
359
360
361
362
363
364
365
  static const unsigned int fixed_2400000_ilimsel[] = {
  	2400000
  };
  
  static const unsigned int fixed_1200000_ilimsel[] = {
  	1200000
  };
  
  static const unsigned int fixed_400000_ilimsel[] = {
  	400000
  };
1394fd282   Cyril Chemparathy   regulator: add dr...
366
367
368
369
370
371
  #define __MK_FIELD(_reg, _mask, _shift) \
  	{ .reg = (_reg), .mask = (_mask), .shift = (_shift), }
  
  static const struct supply_info supply_info[N_REGULATORS] = {
  	{
  		.name		= "DCDC1",
1394fd282   Cyril Chemparathy   regulator: add dr...
372
373
  		.n_voltages	= ARRAY_SIZE(dcdc1_voltages),
  		.voltages	= dcdc1_voltages,
1e12dfc96   Axel Lin   regulator: tps652...
374
375
  		.n_ilimsels	= ARRAY_SIZE(fixed_2400000_ilimsel),
  		.ilimsels	= fixed_2400000_ilimsel,
1394fd282   Cyril Chemparathy   regulator: add dr...
376
377
378
379
380
381
382
  		.enable		= __MK_FIELD(REG_DCDC_EN, DCDCDCDC_EN_MASK,
  					     DCDCDCDC1_EN_SHIFT),
  		.voltage	= __MK_FIELD(REG_DCDC_SET, DCDC_VDCDC_MASK,
  					     DCDC_VDCDC1_SHIFT),
  	},
  	{
  		.name		= "DCDC2",
1394fd282   Cyril Chemparathy   regulator: add dr...
383
384
  		.n_voltages	= ARRAY_SIZE(dcdc2_voltages),
  		.voltages	= dcdc2_voltages,
1e12dfc96   Axel Lin   regulator: tps652...
385
386
  		.n_ilimsels	= ARRAY_SIZE(fixed_1200000_ilimsel),
  		.ilimsels	= fixed_1200000_ilimsel,
1394fd282   Cyril Chemparathy   regulator: add dr...
387
388
389
390
391
392
393
  		.enable		= __MK_FIELD(REG_DCDC_EN, DCDCDCDC_EN_MASK,
  					     DCDCDCDC2_EN_SHIFT),
  		.voltage	= __MK_FIELD(REG_DCDC_SET, DCDC_VDCDC_MASK,
  					     DCDC_VDCDC2_SHIFT),
  	},
  	{
  		.name		= "DCDC3",
1394fd282   Cyril Chemparathy   regulator: add dr...
394
395
  		.n_voltages	= ARRAY_SIZE(dcdc3_voltages),
  		.voltages	= dcdc3_voltages,
1e12dfc96   Axel Lin   regulator: tps652...
396
397
  		.n_ilimsels	= ARRAY_SIZE(fixed_1200000_ilimsel),
  		.ilimsels	= fixed_1200000_ilimsel,
1394fd282   Cyril Chemparathy   regulator: add dr...
398
399
400
401
402
403
404
405
406
407
408
409
410
411
412
413
414
415
416
417
418
419
420
421
422
423
424
425
426
427
428
429
430
  		.enable		= __MK_FIELD(REG_DCDC_EN, DCDCDCDC_EN_MASK,
  					DCDCDCDC3_EN_SHIFT),
  		.voltage	= __MK_FIELD(REG_DCDC_SET, DCDC_VDCDC_MASK,
  					     DCDC_VDCDC3_SHIFT),
  	},
  	{
  		.name		= "LDO1",
  		.n_voltages	= ARRAY_SIZE(ldo1_voltages),
  		.voltages	= ldo1_voltages,
  		.n_ilimsels	= ARRAY_SIZE(ldo_ilimsel),
  		.ilimsels	= ldo_ilimsel,
  		.enable		= __MK_FIELD(REG_BLOCK_EN, BLOCK_MASK,
  					     BLOCK_LDO1_SHIFT),
  		.voltage	= __MK_FIELD(REG_LDO_SET, LDO_VSEL_MASK,
  					     LDO1_VSEL_SHIFT),
  		.ilimsel	= __MK_FIELD(REG_LDO_SET, LDO_ILIM_MASK,
  					     LDO1_ILIM_SHIFT),
  	},
  	{
  		.name		= "LDO2",
  		.n_voltages	= ARRAY_SIZE(ldo2_voltages),
  		.voltages	= ldo2_voltages,
  		.n_ilimsels	= ARRAY_SIZE(ldo_ilimsel),
  		.ilimsels	= ldo_ilimsel,
  		.enable		= __MK_FIELD(REG_BLOCK_EN, BLOCK_MASK,
  					     BLOCK_LDO2_SHIFT),
  		.voltage	= __MK_FIELD(REG_LDO_SET, LDO_VSEL_MASK,
  					     LDO2_VSEL_SHIFT),
  		.ilimsel	= __MK_FIELD(REG_LDO_SET, LDO_ILIM_MASK,
  					     LDO2_ILIM_SHIFT),
  	},
  	{
  		.name		= "USB",
cac87fd34   Axel Lin   regulator: tps652...
431
432
  		.n_voltages	= ARRAY_SIZE(fixed_5000000_voltage),
  		.voltages	= fixed_5000000_voltage,
1394fd282   Cyril Chemparathy   regulator: add dr...
433
434
435
436
437
438
439
440
441
  		.n_ilimsels	= ARRAY_SIZE(usb_ilimsel),
  		.ilimsels	= usb_ilimsel,
  		.enable		= __MK_FIELD(REG_BLOCK_EN, BLOCK_MASK,
  					     BLOCK_USB_SHIFT),
  		.ilimsel	= __MK_FIELD(REG_USB, USB_ILIM_MASK,
  					     USB_ILIM_SHIFT),
  	},
  	{
  		.name		= "LCD",
cac87fd34   Axel Lin   regulator: tps652...
442
443
  		.n_voltages	= ARRAY_SIZE(fixed_5000000_voltage),
  		.voltages	= fixed_5000000_voltage,
1e12dfc96   Axel Lin   regulator: tps652...
444
445
  		.n_ilimsels	= ARRAY_SIZE(fixed_400000_ilimsel),
  		.ilimsels	= fixed_400000_ilimsel,
1394fd282   Cyril Chemparathy   regulator: add dr...
446
447
448
449
  		.enable		= __MK_FIELD(REG_BLOCK_EN, BLOCK_MASK,
  					     BLOCK_LCD_SHIFT),
  	},
  };
f8ee33936   Axel Lin   regulator: Conver...
450
  static int set_voltage_sel(struct regulator_dev *rdev, unsigned selector)
1394fd282   Cyril Chemparathy   regulator: add dr...
451
452
453
  {
  	const struct supply_info *info;
  	struct tps6524x *hw;
1394fd282   Cyril Chemparathy   regulator: add dr...
454
455
456
  
  	hw	= rdev_get_drvdata(rdev);
  	info	= &supply_info[rdev_get_id(rdev)];
cac87fd34   Axel Lin   regulator: tps652...
457
  	if (rdev->desc->n_voltages == 1)
1394fd282   Cyril Chemparathy   regulator: add dr...
458
  		return -EINVAL;
f8ee33936   Axel Lin   regulator: Conver...
459
  	return write_field(hw, &info->voltage, selector);
1394fd282   Cyril Chemparathy   regulator: add dr...
460
  }
4af7c1d31   Axel Lin   regulator: Conver...
461
  static int get_voltage_sel(struct regulator_dev *rdev)
1394fd282   Cyril Chemparathy   regulator: add dr...
462
463
464
465
466
467
468
  {
  	const struct supply_info *info;
  	struct tps6524x *hw;
  	int ret;
  
  	hw	= rdev_get_drvdata(rdev);
  	info	= &supply_info[rdev_get_id(rdev)];
cac87fd34   Axel Lin   regulator: tps652...
469
  	if (rdev->desc->n_voltages == 1)
8386a00f1   Axel Lin   regulator: tps652...
470
  		return 0;
1394fd282   Cyril Chemparathy   regulator: add dr...
471
472
473
474
475
476
  
  	ret = read_field(hw, &info->voltage);
  	if (ret < 0)
  		return ret;
  	if (WARN_ON(ret >= info->n_voltages))
  		return -EIO;
4af7c1d31   Axel Lin   regulator: Conver...
477
  	return ret;
1394fd282   Cyril Chemparathy   regulator: add dr...
478
479
480
481
482
483
484
485
486
487
488
  }
  
  static int set_current_limit(struct regulator_dev *rdev, int min_uA,
  			     int max_uA)
  {
  	const struct supply_info *info;
  	struct tps6524x *hw;
  	int i;
  
  	hw	= rdev_get_drvdata(rdev);
  	info	= &supply_info[rdev_get_id(rdev)];
1e12dfc96   Axel Lin   regulator: tps652...
489
  	if (info->n_ilimsels == 1)
1394fd282   Cyril Chemparathy   regulator: add dr...
490
  		return -EINVAL;
73f4f3d37   Axel Lin   regulator: tps652...
491
  	for (i = info->n_ilimsels - 1; i >= 0; i--) {
1394fd282   Cyril Chemparathy   regulator: add dr...
492
493
  		if (min_uA <= info->ilimsels[i] &&
  		    max_uA >= info->ilimsels[i])
73f4f3d37   Axel Lin   regulator: tps652...
494
495
  			return write_field(hw, &info->ilimsel, i);
  	}
1394fd282   Cyril Chemparathy   regulator: add dr...
496

73f4f3d37   Axel Lin   regulator: tps652...
497
  	return -EINVAL;
1394fd282   Cyril Chemparathy   regulator: add dr...
498
499
500
501
502
503
504
505
506
507
  }
  
  static int get_current_limit(struct regulator_dev *rdev)
  {
  	const struct supply_info *info;
  	struct tps6524x *hw;
  	int ret;
  
  	hw	= rdev_get_drvdata(rdev);
  	info	= &supply_info[rdev_get_id(rdev)];
1e12dfc96   Axel Lin   regulator: tps652...
508
509
  	if (info->n_ilimsels == 1)
  		return info->ilimsels[0];
1394fd282   Cyril Chemparathy   regulator: add dr...
510
511
512
513
514
515
516
517
518
519
520
521
522
523
524
525
526
527
528
529
530
531
532
533
534
535
536
537
538
539
540
541
542
543
544
545
546
547
548
549
550
551
  
  	ret = read_field(hw, &info->ilimsel);
  	if (ret < 0)
  		return ret;
  	if (WARN_ON(ret >= info->n_ilimsels))
  		return -EIO;
  
  	return info->ilimsels[ret];
  }
  
  static int enable_supply(struct regulator_dev *rdev)
  {
  	const struct supply_info *info;
  	struct tps6524x *hw;
  
  	hw	= rdev_get_drvdata(rdev);
  	info	= &supply_info[rdev_get_id(rdev)];
  
  	return write_field(hw, &info->enable, 1);
  }
  
  static int disable_supply(struct regulator_dev *rdev)
  {
  	const struct supply_info *info;
  	struct tps6524x *hw;
  
  	hw	= rdev_get_drvdata(rdev);
  	info	= &supply_info[rdev_get_id(rdev)];
  
  	return write_field(hw, &info->enable, 0);
  }
  
  static int is_supply_enabled(struct regulator_dev *rdev)
  {
  	const struct supply_info *info;
  	struct tps6524x *hw;
  
  	hw	= rdev_get_drvdata(rdev);
  	info	= &supply_info[rdev_get_id(rdev)];
  
  	return read_field(hw, &info->enable);
  }
357db0279   Axel Lin   regulator: tps652...
552
  static const struct regulator_ops regulator_ops = {
1394fd282   Cyril Chemparathy   regulator: add dr...
553
554
555
  	.is_enabled		= is_supply_enabled,
  	.enable			= enable_supply,
  	.disable		= disable_supply,
4af7c1d31   Axel Lin   regulator: Conver...
556
  	.get_voltage_sel	= get_voltage_sel,
f8ee33936   Axel Lin   regulator: Conver...
557
  	.set_voltage_sel	= set_voltage_sel,
cac87fd34   Axel Lin   regulator: tps652...
558
  	.list_voltage		= regulator_list_voltage_table,
b92f567de   Axel Lin   regulator: tps652...
559
  	.map_voltage		= regulator_map_voltage_ascend,
1394fd282   Cyril Chemparathy   regulator: add dr...
560
561
562
  	.set_current_limit	= set_current_limit,
  	.get_current_limit	= get_current_limit,
  };
a5023574d   Bill Pemberton   regulator: remove...
563
  static int pmic_probe(struct spi_device *spi)
1394fd282   Cyril Chemparathy   regulator: add dr...
564
565
566
567
568
  {
  	struct tps6524x *hw;
  	struct device *dev = &spi->dev;
  	const struct supply_info *info = supply_info;
  	struct regulator_init_data *init_data;
c172708d3   Mark Brown   regulator: core: ...
569
  	struct regulator_config config = { };
7a8b0e66d   Axel Lin   regulator: tps652...
570
  	struct regulator_dev *rdev;
5e0855759   Jingoo Han   regulator: tps652...
571
  	int i;
1394fd282   Cyril Chemparathy   regulator: add dr...
572

dff91d0b7   Jingoo Han   regulator: use de...
573
  	init_data = dev_get_platdata(dev);
1394fd282   Cyril Chemparathy   regulator: add dr...
574
575
576
577
578
  	if (!init_data) {
  		dev_err(dev, "could not find regulator platform data
  ");
  		return -EINVAL;
  	}
9eb0c4218   Axel Lin   regulator: Conver...
579
  	hw = devm_kzalloc(&spi->dev, sizeof(struct tps6524x), GFP_KERNEL);
516add1d9   Sachin Kamat   regulator: tps652...
580
  	if (!hw)
1394fd282   Cyril Chemparathy   regulator: add dr...
581
  		return -ENOMEM;
516add1d9   Sachin Kamat   regulator: tps652...
582

1394fd282   Cyril Chemparathy   regulator: add dr...
583
584
585
586
  	spi_set_drvdata(spi, hw);
  
  	memset(hw, 0, sizeof(struct tps6524x));
  	hw->dev = dev;
ae714c3b8   Mark Brown   regulator: tps652...
587
  	hw->spi = spi;
1394fd282   Cyril Chemparathy   regulator: add dr...
588
589
590
591
592
593
  	mutex_init(&hw->lock);
  
  	for (i = 0; i < N_REGULATORS; i++, info++, init_data++) {
  		hw->desc[i].name	= info->name;
  		hw->desc[i].id		= i;
  		hw->desc[i].n_voltages	= info->n_voltages;
cac87fd34   Axel Lin   regulator: tps652...
594
  		hw->desc[i].volt_table	= info->voltages;
1394fd282   Cyril Chemparathy   regulator: add dr...
595
596
597
  		hw->desc[i].ops		= &regulator_ops;
  		hw->desc[i].type	= REGULATOR_VOLTAGE;
  		hw->desc[i].owner	= THIS_MODULE;
c172708d3   Mark Brown   regulator: core: ...
598
599
600
  		config.dev = dev;
  		config.init_data = init_data;
  		config.driver_data = hw;
7a8b0e66d   Axel Lin   regulator: tps652...
601
602
603
  		rdev = devm_regulator_register(dev, &hw->desc[i], &config);
  		if (IS_ERR(rdev))
  			return PTR_ERR(rdev);
1394fd282   Cyril Chemparathy   regulator: add dr...
604
605
606
  	}
  
  	return 0;
1394fd282   Cyril Chemparathy   regulator: add dr...
607
608
609
610
  }
  
  static struct spi_driver pmic_driver = {
  	.probe		= pmic_probe,
1394fd282   Cyril Chemparathy   regulator: add dr...
611
612
  	.driver		= {
  		.name	= "tps6524x",
1394fd282   Cyril Chemparathy   regulator: add dr...
613
614
  	},
  };
173f24d1f   Mark Brown   regulator: tps652...
615
  module_spi_driver(pmic_driver);
1394fd282   Cyril Chemparathy   regulator: add dr...
616
617
618
619
620
  
  MODULE_DESCRIPTION("TPS6524X PMIC Driver");
  MODULE_AUTHOR("Cyril Chemparathy");
  MODULE_LICENSE("GPL");
  MODULE_ALIAS("spi:tps6524x");