?  search:
summary | log | graphiclog1 | graphiclog2 | commit | commitdiff | tree | refs | edit | fork
blame | history | raw | HEAD
treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / mfd / menelaus.c
blobb64d3315a5e13b58521b7d637b9868f89a3ea39c
1 // SPDX-License-Identifier: GPL-2.0-or-later
2 /*
3 * Copyright (C) 2004 Texas Instruments, Inc.
4 *
5 * Some parts based tps65010.c:
6 * Copyright (C) 2004 Texas Instruments and
7 * Copyright (C) 2004-2005 David Brownell
8 *
9 * Some parts based on tlv320aic24.c:
10 * Copyright (C) by Kai Svahn <kai.svahn@nokia.com>
11 *
12 * Changes for interrupt handling and clean-up by
13 * Tony Lindgren <tony@atomide.com> and Imre Deak <imre.deak@nokia.com>
14 * Cleanup and generalized support for voltage setting by
15 * Juha Yrjola
16 * Added support for controlling VCORE and regulator sleep states,
17 * Amit Kucheria <amit.kucheria@nokia.com>
18 * Copyright (C) 2005, 2006 Nokia Corporation
19 */
20
21 #include <linux/module.h>
22 #include <linux/i2c.h>
23 #include <linux/interrupt.h>
24 #include <linux/sched.h>
25 #include <linux/mutex.h>
26 #include <linux/workqueue.h>
27 #include <linux/delay.h>
28 #include <linux/rtc.h>
29 #include <linux/bcd.h>
30 #include <linux/slab.h>
31 #include <linux/mfd/menelaus.h>
32 #include <linux/gpio.h>
33
34 #include <asm/mach/irq.h>
35
36
37 #define DRIVER_NAME "menelaus"
38
39 #define MENELAUS_I2C_ADDRESS 0x72
40
41 #define MENELAUS_REV 0x01
42 #define MENELAUS_VCORE_CTRL1 0x02
43 #define MENELAUS_VCORE_CTRL2 0x03
44 #define MENELAUS_VCORE_CTRL3 0x04
45 #define MENELAUS_VCORE_CTRL4 0x05
46 #define MENELAUS_VCORE_CTRL5 0x06
47 #define MENELAUS_DCDC_CTRL1 0x07
48 #define MENELAUS_DCDC_CTRL2 0x08
49 #define MENELAUS_DCDC_CTRL3 0x09
50 #define MENELAUS_LDO_CTRL1 0x0A
51 #define MENELAUS_LDO_CTRL2 0x0B
52 #define MENELAUS_LDO_CTRL3 0x0C
53 #define MENELAUS_LDO_CTRL4 0x0D
54 #define MENELAUS_LDO_CTRL5 0x0E
55 #define MENELAUS_LDO_CTRL6 0x0F
56 #define MENELAUS_LDO_CTRL7 0x10
57 #define MENELAUS_LDO_CTRL8 0x11
58 #define MENELAUS_SLEEP_CTRL1 0x12
59 #define MENELAUS_SLEEP_CTRL2 0x13
60 #define MENELAUS_DEVICE_OFF 0x14
61 #define MENELAUS_OSC_CTRL 0x15
62 #define MENELAUS_DETECT_CTRL 0x16
63 #define MENELAUS_INT_MASK1 0x17
64 #define MENELAUS_INT_MASK2 0x18
65 #define MENELAUS_INT_STATUS1 0x19
66 #define MENELAUS_INT_STATUS2 0x1A
67 #define MENELAUS_INT_ACK1 0x1B
68 #define MENELAUS_INT_ACK2 0x1C
69 #define MENELAUS_GPIO_CTRL 0x1D
70 #define MENELAUS_GPIO_IN 0x1E
71 #define MENELAUS_GPIO_OUT 0x1F
72 #define MENELAUS_BBSMS 0x20
73 #define MENELAUS_RTC_CTRL 0x21
74 #define MENELAUS_RTC_UPDATE 0x22
75 #define MENELAUS_RTC_SEC 0x23
76 #define MENELAUS_RTC_MIN 0x24
77 #define MENELAUS_RTC_HR 0x25
78 #define MENELAUS_RTC_DAY 0x26
79 #define MENELAUS_RTC_MON 0x27
80 #define MENELAUS_RTC_YR 0x28
81 #define MENELAUS_RTC_WKDAY 0x29
82 #define MENELAUS_RTC_AL_SEC 0x2A
83 #define MENELAUS_RTC_AL_MIN 0x2B
84 #define MENELAUS_RTC_AL_HR 0x2C
85 #define MENELAUS_RTC_AL_DAY 0x2D
86 #define MENELAUS_RTC_AL_MON 0x2E
87 #define MENELAUS_RTC_AL_YR 0x2F
88 #define MENELAUS_RTC_COMP_MSB 0x30
89 #define MENELAUS_RTC_COMP_LSB 0x31
90 #define MENELAUS_S1_PULL_EN 0x32
91 #define MENELAUS_S1_PULL_DIR 0x33
92 #define MENELAUS_S2_PULL_EN 0x34
93 #define MENELAUS_S2_PULL_DIR 0x35
94 #define MENELAUS_MCT_CTRL1 0x36
95 #define MENELAUS_MCT_CTRL2 0x37
96 #define MENELAUS_MCT_CTRL3 0x38
97 #define MENELAUS_MCT_PIN_ST 0x39
98 #define MENELAUS_DEBOUNCE1 0x3A
99
100 #define IH_MENELAUS_IRQS 12
101 #define MENELAUS_MMC_S1CD_IRQ 0 /* MMC slot 1 card change */
102 #define MENELAUS_MMC_S2CD_IRQ 1 /* MMC slot 2 card change */
103 #define MENELAUS_MMC_S1D1_IRQ 2 /* MMC DAT1 low in slot 1 */
104 #define MENELAUS_MMC_S2D1_IRQ 3 /* MMC DAT1 low in slot 2 */
105 #define MENELAUS_LOWBAT_IRQ 4 /* Low battery */
106 #define MENELAUS_HOTDIE_IRQ 5 /* Hot die detect */
107 #define MENELAUS_UVLO_IRQ 6 /* UVLO detect */
108 #define MENELAUS_TSHUT_IRQ 7 /* Thermal shutdown */
109 #define MENELAUS_RTCTMR_IRQ 8 /* RTC timer */
110 #define MENELAUS_RTCALM_IRQ 9 /* RTC alarm */
111 #define MENELAUS_RTCERR_IRQ 10 /* RTC error */
112 #define MENELAUS_PSHBTN_IRQ 11 /* Push button */
113 #define MENELAUS_RESERVED12_IRQ 12 /* Reserved */
114 #define MENELAUS_RESERVED13_IRQ 13 /* Reserved */
115 #define MENELAUS_RESERVED14_IRQ 14 /* Reserved */
116 #define MENELAUS_RESERVED15_IRQ 15 /* Reserved */
117
118 /* VCORE_CTRL1 register */
119 #define VCORE_CTRL1_BYP_COMP (1 << 5)
120 #define VCORE_CTRL1_HW_NSW (1 << 7)
121
122 /* GPIO_CTRL register */
123 #define GPIO_CTRL_SLOTSELEN (1 << 5)
124 #define GPIO_CTRL_SLPCTLEN (1 << 6)
125 #define GPIO1_DIR_INPUT (1 << 0)
126 #define GPIO2_DIR_INPUT (1 << 1)
127 #define GPIO3_DIR_INPUT (1 << 2)
128
129 /* MCT_CTRL1 register */
130 #define MCT_CTRL1_S1_CMD_OD (1 << 2)
131 #define MCT_CTRL1_S2_CMD_OD (1 << 3)
132
133 /* MCT_CTRL2 register */
134 #define MCT_CTRL2_VS2_SEL_D0 (1 << 0)
135 #define MCT_CTRL2_VS2_SEL_D1 (1 << 1)
136 #define MCT_CTRL2_S1CD_BUFEN (1 << 4)
137 #define MCT_CTRL2_S2CD_BUFEN (1 << 5)
138 #define MCT_CTRL2_S1CD_DBEN (1 << 6)
139 #define MCT_CTRL2_S2CD_BEN (1 << 7)
140
141 /* MCT_CTRL3 register */
142 #define MCT_CTRL3_SLOT1_EN (1 << 0)
143 #define MCT_CTRL3_SLOT2_EN (1 << 1)
144 #define MCT_CTRL3_S1_AUTO_EN (1 << 2)
145 #define MCT_CTRL3_S2_AUTO_EN (1 << 3)
146
147 /* MCT_PIN_ST register */
148 #define MCT_PIN_ST_S1_CD_ST (1 << 0)
149 #define MCT_PIN_ST_S2_CD_ST (1 << 1)
150
151 static void menelaus_work(struct work_struct *_menelaus);
152
153 struct menelaus_chip {
154 struct mutex lock;
155 struct i2c_client *client;
156 struct work_struct work;
157 #ifdef CONFIG_RTC_DRV_TWL92330
158 struct rtc_device *rtc;
159 u8 rtc_control;
160 unsigned uie:1;
161 #endif
162 unsigned vcore_hw_mode:1;
163 u8 mask1, mask2;
164 void (*handlers[16])(struct menelaus_chip *);
165 void (*mmc_callback)(void *data, u8 mask);
166 void *mmc_callback_data;
167 };
168
169 static struct menelaus_chip *the_menelaus;
170
171 static int menelaus_write_reg(int reg, u8 value)
172 {
173 int val = i2c_smbus_write_byte_data(the_menelaus->client, reg, value);
174
175 if (val < 0) {
176 pr_err(DRIVER_NAME ": write error");
177 return val;
178 }
179
180 return 0;
181 }
182
183 static int menelaus_read_reg(int reg)
184 {
185 int val = i2c_smbus_read_byte_data(the_menelaus->client, reg);
186
187 if (val < 0)
188 pr_err(DRIVER_NAME ": read error");
189
190 return val;
191 }
192
193 static int menelaus_enable_irq(int irq)
194 {
195 if (irq > 7) {
196 irq -= 8;
197 the_menelaus->mask2 &= ~(1 << irq);
198 return menelaus_write_reg(MENELAUS_INT_MASK2,
199 the_menelaus->mask2);
200 } else {
201 the_menelaus->mask1 &= ~(1 << irq);
202 return menelaus_write_reg(MENELAUS_INT_MASK1,
203 the_menelaus->mask1);
204 }
205 }
206
207 static int menelaus_disable_irq(int irq)
208 {
209 if (irq > 7) {
210 irq -= 8;
211 the_menelaus->mask2 |= (1 << irq);
212 return menelaus_write_reg(MENELAUS_INT_MASK2,
213 the_menelaus->mask2);
214 } else {
215 the_menelaus->mask1 |= (1 << irq);
216 return menelaus_write_reg(MENELAUS_INT_MASK1,
217 the_menelaus->mask1);
218 }
219 }
220
221 static int menelaus_ack_irq(int irq)
222 {
223 if (irq > 7)
224 return menelaus_write_reg(MENELAUS_INT_ACK2, 1 << (irq - 8));
225 else
226 return menelaus_write_reg(MENELAUS_INT_ACK1, 1 << irq);
227 }
228
229 /* Adds a handler for an interrupt. Does not run in interrupt context */
230 static int menelaus_add_irq_work(int irq,
231 void (*handler)(struct menelaus_chip *))
232 {
233 int ret = 0;
234
235 mutex_lock(&the_menelaus->lock);
236 the_menelaus->handlers[irq] = handler;
237 ret = menelaus_enable_irq(irq);
238 mutex_unlock(&the_menelaus->lock);
239
240 return ret;
241 }
242
243 /* Removes handler for an interrupt */
244 static int menelaus_remove_irq_work(int irq)
245 {
246 int ret = 0;
247
248 mutex_lock(&the_menelaus->lock);
249 ret = menelaus_disable_irq(irq);
250 the_menelaus->handlers[irq] = NULL;
251 mutex_unlock(&the_menelaus->lock);
252
253 return ret;
254 }
255
256 /*
257 * Gets scheduled when a card detect interrupt happens. Note that in some cases
258 * this line is wired to card cover switch rather than the card detect switch
259 * in each slot. In this case the cards are not seen by menelaus.
260 * FIXME: Add handling for D1 too
261 */
262 static void menelaus_mmc_cd_work(struct menelaus_chip *menelaus_hw)
263 {
264 int reg;
265 unsigned char card_mask = 0;
266
267 reg = menelaus_read_reg(MENELAUS_MCT_PIN_ST);
268 if (reg < 0)
269 return;
270
271 if (!(reg & 0x1))
272 card_mask |= MCT_PIN_ST_S1_CD_ST;
273
274 if (!(reg & 0x2))
275 card_mask |= MCT_PIN_ST_S2_CD_ST;
276
277 if (menelaus_hw->mmc_callback)
278 menelaus_hw->mmc_callback(menelaus_hw->mmc_callback_data,
279 card_mask);
280 }
281
282 /*
283 * Toggles the MMC slots between open-drain and push-pull mode.
284 */
285 int menelaus_set_mmc_opendrain(int slot, int enable)
286 {
287 int ret, val;
288
289 if (slot != 1 && slot != 2)
290 return -EINVAL;
291 mutex_lock(&the_menelaus->lock);
292 ret = menelaus_read_reg(MENELAUS_MCT_CTRL1);
293 if (ret < 0) {
294 mutex_unlock(&the_menelaus->lock);
295 return ret;
296 }
297 val = ret;
298 if (slot == 1) {
299 if (enable)
300 val |= MCT_CTRL1_S1_CMD_OD;
301 else
302 val &= ~MCT_CTRL1_S1_CMD_OD;
303 } else {
304 if (enable)
305 val |= MCT_CTRL1_S2_CMD_OD;
306 else
307 val &= ~MCT_CTRL1_S2_CMD_OD;
308 }
309 ret = menelaus_write_reg(MENELAUS_MCT_CTRL1, val);
310 mutex_unlock(&the_menelaus->lock);
311
312 return ret;
313 }
314 EXPORT_SYMBOL(menelaus_set_mmc_opendrain);
315
316 int menelaus_set_slot_sel(int enable)
317 {
318 int ret;
319
320 mutex_lock(&the_menelaus->lock);
321 ret = menelaus_read_reg(MENELAUS_GPIO_CTRL);
322 if (ret < 0)
323 goto out;
324 ret |= GPIO2_DIR_INPUT;
325 if (enable)
326 ret |= GPIO_CTRL_SLOTSELEN;
327 else
328 ret &= ~GPIO_CTRL_SLOTSELEN;
329 ret = menelaus_write_reg(MENELAUS_GPIO_CTRL, ret);
330 out:
331 mutex_unlock(&the_menelaus->lock);
332 return ret;
333 }
334 EXPORT_SYMBOL(menelaus_set_slot_sel);
335
336 int menelaus_set_mmc_slot(int slot, int enable, int power, int cd_en)
337 {
338 int ret, val;
339
340 if (slot != 1 && slot != 2)
341 return -EINVAL;
342 if (power >= 3)
343 return -EINVAL;
344
345 mutex_lock(&the_menelaus->lock);
346
347 ret = menelaus_read_reg(MENELAUS_MCT_CTRL2);
348 if (ret < 0)
349 goto out;
350 val = ret;
351 if (slot == 1) {
352 if (cd_en)
353 val |= MCT_CTRL2_S1CD_BUFEN | MCT_CTRL2_S1CD_DBEN;
354 else
355 val &= ~(MCT_CTRL2_S1CD_BUFEN | MCT_CTRL2_S1CD_DBEN);
356 } else {
357 if (cd_en)
358 val |= MCT_CTRL2_S2CD_BUFEN | MCT_CTRL2_S2CD_BEN;
359 else
360 val &= ~(MCT_CTRL2_S2CD_BUFEN | MCT_CTRL2_S2CD_BEN);
361 }
362 ret = menelaus_write_reg(MENELAUS_MCT_CTRL2, val);
363 if (ret < 0)
364 goto out;
365
366 ret = menelaus_read_reg(MENELAUS_MCT_CTRL3);
367 if (ret < 0)
368 goto out;
369 val = ret;
370 if (slot == 1) {
371 if (enable)
372 val |= MCT_CTRL3_SLOT1_EN;
373 else
374 val &= ~MCT_CTRL3_SLOT1_EN;
375 } else {
376 int b;
377
378 if (enable)
379 val |= MCT_CTRL3_SLOT2_EN;
380 else
381 val &= ~MCT_CTRL3_SLOT2_EN;
382 b = menelaus_read_reg(MENELAUS_MCT_CTRL2);
383 b &= ~(MCT_CTRL2_VS2_SEL_D0 | MCT_CTRL2_VS2_SEL_D1);
384 b |= power;
385 ret = menelaus_write_reg(MENELAUS_MCT_CTRL2, b);
386 if (ret < 0)
387 goto out;
388 }
389 /* Disable autonomous shutdown */
390 val &= ~(MCT_CTRL3_S1_AUTO_EN | MCT_CTRL3_S2_AUTO_EN);
391 ret = menelaus_write_reg(MENELAUS_MCT_CTRL3, val);
392 out:
393 mutex_unlock(&the_menelaus->lock);
394 return ret;
395 }
396 EXPORT_SYMBOL(menelaus_set_mmc_slot);
397
398 int menelaus_register_mmc_callback(void (*callback)(void *data, u8 card_mask),
399 void *data)
400 {
401 int ret = 0;
402
403 the_menelaus->mmc_callback_data = data;
404 the_menelaus->mmc_callback = callback;
405 ret = menelaus_add_irq_work(MENELAUS_MMC_S1CD_IRQ,
406 menelaus_mmc_cd_work);
407 if (ret < 0)
408 return ret;
409 ret = menelaus_add_irq_work(MENELAUS_MMC_S2CD_IRQ,
410 menelaus_mmc_cd_work);
411 if (ret < 0)
412 return ret;
413 ret = menelaus_add_irq_work(MENELAUS_MMC_S1D1_IRQ,
414 menelaus_mmc_cd_work);
415 if (ret < 0)
416 return ret;
417 ret = menelaus_add_irq_work(MENELAUS_MMC_S2D1_IRQ,
418 menelaus_mmc_cd_work);
419
420 return ret;
421 }
422 EXPORT_SYMBOL(menelaus_register_mmc_callback);
423
424 void menelaus_unregister_mmc_callback(void)
425 {
426 menelaus_remove_irq_work(MENELAUS_MMC_S1CD_IRQ);
427 menelaus_remove_irq_work(MENELAUS_MMC_S2CD_IRQ);
428 menelaus_remove_irq_work(MENELAUS_MMC_S1D1_IRQ);
429 menelaus_remove_irq_work(MENELAUS_MMC_S2D1_IRQ);
430
431 the_menelaus->mmc_callback = NULL;
432 the_menelaus->mmc_callback_data = NULL;
433 }
434 EXPORT_SYMBOL(menelaus_unregister_mmc_callback);
435
436 struct menelaus_vtg {
437 const char *name;
438 u8 vtg_reg;
439 u8 vtg_shift;
440 u8 vtg_bits;
441 u8 mode_reg;
442 };
443
444 struct menelaus_vtg_value {
445 u16 vtg;
446 u16 val;
447 };
448
449 static int menelaus_set_voltage(const struct menelaus_vtg *vtg, int mV,
450 int vtg_val, int mode)
451 {
452 int val, ret;
453 struct i2c_client *c = the_menelaus->client;
454
455 mutex_lock(&the_menelaus->lock);
456
457 ret = menelaus_read_reg(vtg->vtg_reg);
458 if (ret < 0)
459 goto out;
460 val = ret & ~(((1 << vtg->vtg_bits) - 1) << vtg->vtg_shift);
461 val |= vtg_val << vtg->vtg_shift;
462
463 dev_dbg(&c->dev, "Setting voltage '%s'"
464 "to %d mV (reg 0x%02x, val 0x%02x)\n",
465 vtg->name, mV, vtg->vtg_reg, val);
466
467 ret = menelaus_write_reg(vtg->vtg_reg, val);
468 if (ret < 0)
469 goto out;
470 ret = menelaus_write_reg(vtg->mode_reg, mode);
471 out:
472 mutex_unlock(&the_menelaus->lock);
473 if (ret == 0) {
474 /* Wait for voltage to stabilize */
475 msleep(1);
476 }
477 return ret;
478 }
479
480 static int menelaus_get_vtg_value(int vtg, const struct menelaus_vtg_value *tbl,
481 int n)
482 {
483 int i;
484
485 for (i = 0; i < n; i++, tbl++)
486 if (tbl->vtg == vtg)
487 return tbl->val;
488 return -EINVAL;
489 }
490
491 /*
492 * Vcore can be programmed in two ways:
493 * SW-controlled: Required voltage is programmed into VCORE_CTRL1
494 * HW-controlled: Required range (roof-floor) is programmed into VCORE_CTRL3
495 * and VCORE_CTRL4
496 *
497 * Call correct 'set' function accordingly
498 */
499
500 static const struct menelaus_vtg_value vcore_values[] = {
501 { 1000, 0 },
502 { 1025, 1 },
503 { 1050, 2 },
504 { 1075, 3 },
505 { 1100, 4 },
506 { 1125, 5 },
507 { 1150, 6 },
508 { 1175, 7 },
509 { 1200, 8 },
510 { 1225, 9 },
511 { 1250, 10 },
512 { 1275, 11 },
513 { 1300, 12 },
514 { 1325, 13 },
515 { 1350, 14 },
516 { 1375, 15 },
517 { 1400, 16 },
518 { 1425, 17 },
519 { 1450, 18 },
520 };
521
522 int menelaus_set_vcore_hw(unsigned int roof_mV, unsigned int floor_mV)
523 {
524 int fval, rval, val, ret;
525 struct i2c_client *c = the_menelaus->client;
526
527 rval = menelaus_get_vtg_value(roof_mV, vcore_values,
528 ARRAY_SIZE(vcore_values));
529 if (rval < 0)
530 return -EINVAL;
531 fval = menelaus_get_vtg_value(floor_mV, vcore_values,
532 ARRAY_SIZE(vcore_values));
533 if (fval < 0)
534 return -EINVAL;
535
536 dev_dbg(&c->dev, "Setting VCORE FLOOR to %d mV and ROOF to %d mV\n",
537 floor_mV, roof_mV);
538
539 mutex_lock(&the_menelaus->lock);
540 ret = menelaus_write_reg(MENELAUS_VCORE_CTRL3, fval);
541 if (ret < 0)
542 goto out;
543 ret = menelaus_write_reg(MENELAUS_VCORE_CTRL4, rval);
544 if (ret < 0)
545 goto out;
546 if (!the_menelaus->vcore_hw_mode) {
547 val = menelaus_read_reg(MENELAUS_VCORE_CTRL1);
548 /* HW mode, turn OFF byte comparator */
549 val |= (VCORE_CTRL1_HW_NSW | VCORE_CTRL1_BYP_COMP);
550 ret = menelaus_write_reg(MENELAUS_VCORE_CTRL1, val);
551 the_menelaus->vcore_hw_mode = 1;
552 }
553 msleep(1);
554 out:
555 mutex_unlock(&the_menelaus->lock);
556 return ret;
557 }
558
559 static const struct menelaus_vtg vmem_vtg = {
560 .name = "VMEM",
561 .vtg_reg = MENELAUS_LDO_CTRL1,
562 .vtg_shift = 0,
563 .vtg_bits = 2,
564 .mode_reg = MENELAUS_LDO_CTRL3,
565 };
566
567 static const struct menelaus_vtg_value vmem_values[] = {
568 { 1500, 0 },
569 { 1800, 1 },
570 { 1900, 2 },
571 { 2500, 3 },
572 };
573
574 int menelaus_set_vmem(unsigned int mV)
575 {
576 int val;
577
578 if (mV == 0)
579 return menelaus_set_voltage(&vmem_vtg, 0, 0, 0);
580
581 val = menelaus_get_vtg_value(mV, vmem_values, ARRAY_SIZE(vmem_values));
582 if (val < 0)
583 return -EINVAL;
584 return menelaus_set_voltage(&vmem_vtg, mV, val, 0x02);
585 }
586 EXPORT_SYMBOL(menelaus_set_vmem);
587
588 static const struct menelaus_vtg vio_vtg = {
589 .name = "VIO",
590 .vtg_reg = MENELAUS_LDO_CTRL1,
591 .vtg_shift = 2,
592 .vtg_bits = 2,
593 .mode_reg = MENELAUS_LDO_CTRL4,
594 };
595
596 static const struct menelaus_vtg_value vio_values[] = {
597 { 1500, 0 },
598 { 1800, 1 },
599 { 2500, 2 },
600 { 2800, 3 },
601 };
602
603 int menelaus_set_vio(unsigned int mV)
604 {
605 int val;
606
607 if (mV == 0)
608 return menelaus_set_voltage(&vio_vtg, 0, 0, 0);
609
610 val = menelaus_get_vtg_value(mV, vio_values, ARRAY_SIZE(vio_values));
611 if (val < 0)
612 return -EINVAL;
613 return menelaus_set_voltage(&vio_vtg, mV, val, 0x02);
614 }
615 EXPORT_SYMBOL(menelaus_set_vio);
616
617 static const struct menelaus_vtg_value vdcdc_values[] = {
618 { 1500, 0 },
619 { 1800, 1 },
620 { 2000, 2 },
621 { 2200, 3 },
622 { 2400, 4 },
623 { 2800, 5 },
624 { 3000, 6 },
625 { 3300, 7 },
626 };
627
628 static const struct menelaus_vtg vdcdc2_vtg = {
629 .name = "VDCDC2",
630 .vtg_reg = MENELAUS_DCDC_CTRL1,
631 .vtg_shift = 0,
632 .vtg_bits = 3,
633 .mode_reg = MENELAUS_DCDC_CTRL2,
634 };
635
636 static const struct menelaus_vtg vdcdc3_vtg = {
637 .name = "VDCDC3",
638 .vtg_reg = MENELAUS_DCDC_CTRL1,
639 .vtg_shift = 3,
640 .vtg_bits = 3,
641 .mode_reg = MENELAUS_DCDC_CTRL3,
642 };
643
644 int menelaus_set_vdcdc(int dcdc, unsigned int mV)
645 {
646 const struct menelaus_vtg *vtg;
647 int val;
648
649 if (dcdc != 2 && dcdc != 3)
650 return -EINVAL;
651 if (dcdc == 2)
652 vtg = &vdcdc2_vtg;
653 else
654 vtg = &vdcdc3_vtg;
655
656 if (mV == 0)
657 return menelaus_set_voltage(vtg, 0, 0, 0);
658
659 val = menelaus_get_vtg_value(mV, vdcdc_values,
660 ARRAY_SIZE(vdcdc_values));
661 if (val < 0)
662 return -EINVAL;
663 return menelaus_set_voltage(vtg, mV, val, 0x03);
664 }
665
666 static const struct menelaus_vtg_value vmmc_values[] = {
667 { 1850, 0 },
668 { 2800, 1 },
669 { 3000, 2 },
670 { 3100, 3 },
671 };
672
673 static const struct menelaus_vtg vmmc_vtg = {
674 .name = "VMMC",
675 .vtg_reg = MENELAUS_LDO_CTRL1,
676 .vtg_shift = 6,
677 .vtg_bits = 2,
678 .mode_reg = MENELAUS_LDO_CTRL7,
679 };
680
681 int menelaus_set_vmmc(unsigned int mV)
682 {
683 int val;
684
685 if (mV == 0)
686 return menelaus_set_voltage(&vmmc_vtg, 0, 0, 0);
687
688 val = menelaus_get_vtg_value(mV, vmmc_values, ARRAY_SIZE(vmmc_values));
689 if (val < 0)
690 return -EINVAL;
691 return menelaus_set_voltage(&vmmc_vtg, mV, val, 0x02);
692 }
693 EXPORT_SYMBOL(menelaus_set_vmmc);
694
695
696 static const struct menelaus_vtg_value vaux_values[] = {
697 { 1500, 0 },
698 { 1800, 1 },
699 { 2500, 2 },
700 { 2800, 3 },
701 };
702
703 static const struct menelaus_vtg vaux_vtg = {
704 .name = "VAUX",
705 .vtg_reg = MENELAUS_LDO_CTRL1,
706 .vtg_shift = 4,
707 .vtg_bits = 2,
708 .mode_reg = MENELAUS_LDO_CTRL6,
709 };
710
711 int menelaus_set_vaux(unsigned int mV)
712 {
713 int val;
714
715 if (mV == 0)
716 return menelaus_set_voltage(&vaux_vtg, 0, 0, 0);
717
718 val = menelaus_get_vtg_value(mV, vaux_values, ARRAY_SIZE(vaux_values));
719 if (val < 0)
720 return -EINVAL;
721 return menelaus_set_voltage(&vaux_vtg, mV, val, 0x02);
722 }
723 EXPORT_SYMBOL(menelaus_set_vaux);
724
725 int menelaus_get_slot_pin_states(void)
726 {
727 return menelaus_read_reg(MENELAUS_MCT_PIN_ST);
728 }
729 EXPORT_SYMBOL(menelaus_get_slot_pin_states);
730
731 int menelaus_set_regulator_sleep(int enable, u32 val)
732 {
733 int t, ret;
734 struct i2c_client *c = the_menelaus->client;
735
736 mutex_lock(&the_menelaus->lock);
737 ret = menelaus_write_reg(MENELAUS_SLEEP_CTRL2, val);
738 if (ret < 0)
739 goto out;
740
741 dev_dbg(&c->dev, "regulator sleep configuration: %02x\n", val);
742
743 ret = menelaus_read_reg(MENELAUS_GPIO_CTRL);
744 if (ret < 0)
745 goto out;
746 t = (GPIO_CTRL_SLPCTLEN | GPIO3_DIR_INPUT);
747 if (enable)
748 ret |= t;
749 else
750 ret &= ~t;
751 ret = menelaus_write_reg(MENELAUS_GPIO_CTRL, ret);
752 out:
753 mutex_unlock(&the_menelaus->lock);
754 return ret;
755 }
756
757 /*-----------------------------------------------------------------------*/
758
759 /* Handles Menelaus interrupts. Does not run in interrupt context */
760 static void menelaus_work(struct work_struct *_menelaus)
761 {
762 struct menelaus_chip *menelaus =
763 container_of(_menelaus, struct menelaus_chip, work);
764 void (*handler)(struct menelaus_chip *menelaus);
765
766 while (1) {
767 unsigned isr;
768
769 isr = (menelaus_read_reg(MENELAUS_INT_STATUS2)
770 & ~menelaus->mask2) << 8;
771 isr |= menelaus_read_reg(MENELAUS_INT_STATUS1)
772 & ~menelaus->mask1;
773 if (!isr)
774 break;
775
776 while (isr) {
777 int irq = fls(isr) - 1;
778 isr &= ~(1 << irq);
779
780 mutex_lock(&menelaus->lock);
781 menelaus_disable_irq(irq);
782 menelaus_ack_irq(irq);
783 handler = menelaus->handlers[irq];
784 if (handler)
785 handler(menelaus);
786 menelaus_enable_irq(irq);
787 mutex_unlock(&menelaus->lock);
788 }
789 }
790 enable_irq(menelaus->client->irq);
791 }
792
793 /*
794 * We cannot use I2C in interrupt context, so we just schedule work.
795 */
796 static irqreturn_t menelaus_irq(int irq, void *_menelaus)
797 {
798 struct menelaus_chip *menelaus = _menelaus;
799
800 disable_irq_nosync(irq);
801 (void)schedule_work(&menelaus->work);
802
803 return IRQ_HANDLED;
804 }
805
806 /*-----------------------------------------------------------------------*/
807
808 /*
809 * The RTC needs to be set once, then it runs on backup battery power.
810 * It supports alarms, including system wake alarms (from some modes);
811 * and 1/second IRQs if requested.
812 */
813 #ifdef CONFIG_RTC_DRV_TWL92330
814
815 #define RTC_CTRL_RTC_EN (1 << 0)
816 #define RTC_CTRL_AL_EN (1 << 1)
817 #define RTC_CTRL_MODE12 (1 << 2)
818 #define RTC_CTRL_EVERY_MASK (3 << 3)
819 #define RTC_CTRL_EVERY_SEC (0 << 3)
820 #define RTC_CTRL_EVERY_MIN (1 << 3)
821 #define RTC_CTRL_EVERY_HR (2 << 3)
822 #define RTC_CTRL_EVERY_DAY (3 << 3)
823
824 #define RTC_UPDATE_EVERY 0x08
825
826 #define RTC_HR_PM (1 << 7)
827
828 static void menelaus_to_time(char *regs, struct rtc_time *t)
829 {
830 t->tm_sec = bcd2bin(regs[0]);
831 t->tm_min = bcd2bin(regs[1]);
832 if (the_menelaus->rtc_control & RTC_CTRL_MODE12) {
833 t->tm_hour = bcd2bin(regs[2] & 0x1f) - 1;
834 if (regs[2] & RTC_HR_PM)
835 t->tm_hour += 12;
836 } else
837 t->tm_hour = bcd2bin(regs[2] & 0x3f);
838 t->tm_mday = bcd2bin(regs[3]);
839 t->tm_mon = bcd2bin(regs[4]) - 1;
840 t->tm_year = bcd2bin(regs[5]) + 100;
841 }
842
843 static int time_to_menelaus(struct rtc_time *t, int regnum)
844 {
845 int hour, status;
846
847 status = menelaus_write_reg(regnum++, bin2bcd(t->tm_sec));
848 if (status < 0)
849 goto fail;
850
851 status = menelaus_write_reg(regnum++, bin2bcd(t->tm_min));
852 if (status < 0)
853 goto fail;
854
855 if (the_menelaus->rtc_control & RTC_CTRL_MODE12) {
856 hour = t->tm_hour + 1;
857 if (hour > 12)
858 hour = RTC_HR_PM | bin2bcd(hour - 12);
859 else
860 hour = bin2bcd(hour);
861 } else
862 hour = bin2bcd(t->tm_hour);
863 status = menelaus_write_reg(regnum++, hour);
864 if (status < 0)
865 goto fail;
866
867 status = menelaus_write_reg(regnum++, bin2bcd(t->tm_mday));
868 if (status < 0)
869 goto fail;
870
871 status = menelaus_write_reg(regnum++, bin2bcd(t->tm_mon + 1));
872 if (status < 0)
873 goto fail;
874
875 status = menelaus_write_reg(regnum++, bin2bcd(t->tm_year - 100));
876 if (status < 0)
877 goto fail;
878
879 return 0;
880 fail:
881 dev_err(&the_menelaus->client->dev, "rtc write reg %02x, err %d\n",
882 --regnum, status);
883 return status;
884 }
885
886 static int menelaus_read_time(struct device *dev, struct rtc_time *t)
887 {
888 struct i2c_msg msg[2];
889 char regs[7];
890 int status;
891
892 /* block read date and time registers */
893 regs[0] = MENELAUS_RTC_SEC;
894
895 msg[0].addr = MENELAUS_I2C_ADDRESS;
896 msg[0].flags = 0;
897 msg[0].len = 1;
898 msg[0].buf = regs;
899
900 msg[1].addr = MENELAUS_I2C_ADDRESS;
901 msg[1].flags = I2C_M_RD;
902 msg[1].len = sizeof(regs);
903 msg[1].buf = regs;
904
905 status = i2c_transfer(the_menelaus->client->adapter, msg, 2);
906 if (status != 2) {
907 dev_err(dev, "%s error %d\n", "read", status);
908 return -EIO;
909 }
910
911 menelaus_to_time(regs, t);
912 t->tm_wday = bcd2bin(regs[6]);
913
914 return 0;
915 }
916
917 static int menelaus_set_time(struct device *dev, struct rtc_time *t)
918 {
919 int status;
920
921 /* write date and time registers */
922 status = time_to_menelaus(t, MENELAUS_RTC_SEC);
923 if (status < 0)
924 return status;
925 status = menelaus_write_reg(MENELAUS_RTC_WKDAY, bin2bcd(t->tm_wday));
926 if (status < 0) {
927 dev_err(&the_menelaus->client->dev, "rtc write reg %02x "
928 "err %d\n", MENELAUS_RTC_WKDAY, status);
929 return status;
930 }
931
932 /* now commit the write */
933 status = menelaus_write_reg(MENELAUS_RTC_UPDATE, RTC_UPDATE_EVERY);
934 if (status < 0)
935 dev_err(&the_menelaus->client->dev, "rtc commit time, err %d\n",
936 status);
937
938 return 0;
939 }
940
941 static int menelaus_read_alarm(struct device *dev, struct rtc_wkalrm *w)
942 {
943 struct i2c_msg msg[2];
944 char regs[6];
945 int status;
946
947 /* block read alarm registers */
948 regs[0] = MENELAUS_RTC_AL_SEC;
949
950 msg[0].addr = MENELAUS_I2C_ADDRESS;
951 msg[0].flags = 0;
952 msg[0].len = 1;
953 msg[0].buf = regs;
954
955 msg[1].addr = MENELAUS_I2C_ADDRESS;
956 msg[1].flags = I2C_M_RD;
957 msg[1].len = sizeof(regs);
958 msg[1].buf = regs;
959
960 status = i2c_transfer(the_menelaus->client->adapter, msg, 2);
961 if (status != 2) {
962 dev_err(dev, "%s error %d\n", "alarm read", status);
963 return -EIO;
964 }
965
966 menelaus_to_time(regs, &w->time);
967
968 w->enabled = !!(the_menelaus->rtc_control & RTC_CTRL_AL_EN);
969
970 /* NOTE we *could* check if actually pending... */
971 w->pending = 0;
972
973 return 0;
974 }
975
976 static int menelaus_set_alarm(struct device *dev, struct rtc_wkalrm *w)
977 {
978 int status;
979
980 if (the_menelaus->client->irq <= 0 && w->enabled)
981 return -ENODEV;
982
983 /* clear previous alarm enable */
984 if (the_menelaus->rtc_control & RTC_CTRL_AL_EN) {
985 the_menelaus->rtc_control &= ~RTC_CTRL_AL_EN;
986 status = menelaus_write_reg(MENELAUS_RTC_CTRL,
987 the_menelaus->rtc_control);
988 if (status < 0)
989 return status;
990 }
991
992 /* write alarm registers */
993 status = time_to_menelaus(&w->time, MENELAUS_RTC_AL_SEC);
994 if (status < 0)
995 return status;
996
997 /* enable alarm if requested */
998 if (w->enabled) {
999 the_menelaus->rtc_control |= RTC_CTRL_AL_EN;
1000 status = menelaus_write_reg(MENELAUS_RTC_CTRL,
1001 the_menelaus->rtc_control);
1002 }
1003
1004 return status;
1005 }
1006
1007 #ifdef CONFIG_RTC_INTF_DEV
1008
1009 static void menelaus_rtc_update_work(struct menelaus_chip *m)
1010 {
1011 /* report 1/sec update */
1012 rtc_update_irq(m->rtc, 1, RTC_IRQF | RTC_UF);
1013 }
1014
1015 static int menelaus_ioctl(struct device *dev, unsigned cmd, unsigned long arg)
1016 {
1017 int status;
1018
1019 if (the_menelaus->client->irq <= 0)
1020 return -ENOIOCTLCMD;
1021
1022 switch (cmd) {
1023 /* alarm IRQ */
1024 case RTC_AIE_ON:
1025 if (the_menelaus->rtc_control & RTC_CTRL_AL_EN)
1026 return 0;
1027 the_menelaus->rtc_control |= RTC_CTRL_AL_EN;
1028 break;
1029 case RTC_AIE_OFF:
1030 if (!(the_menelaus->rtc_control & RTC_CTRL_AL_EN))
1031 return 0;
1032 the_menelaus->rtc_control &= ~RTC_CTRL_AL_EN;
1033 break;
1034 /* 1/second "update" IRQ */
1035 case RTC_UIE_ON:
1036 if (the_menelaus->uie)
1037 return 0;
1038 status = menelaus_remove_irq_work(MENELAUS_RTCTMR_IRQ);
1039 status = menelaus_add_irq_work(MENELAUS_RTCTMR_IRQ,
1040 menelaus_rtc_update_work);
1041 if (status == 0)
1042 the_menelaus->uie = 1;
1043 return status;
1044 case RTC_UIE_OFF:
1045 if (!the_menelaus->uie)
1046 return 0;
1047 status = menelaus_remove_irq_work(MENELAUS_RTCTMR_IRQ);
1048 if (status == 0)
1049 the_menelaus->uie = 0;
1050 return status;
1051 default:
1052 return -ENOIOCTLCMD;
1053 }
1054 return menelaus_write_reg(MENELAUS_RTC_CTRL, the_menelaus->rtc_control);
1055 }
1056
1057 #else
1058 #define menelaus_ioctl NULL
1059 #endif
1060
1061 /* REVISIT no compensation register support ... */
1062
1063 static const struct rtc_class_ops menelaus_rtc_ops = {
1064 .ioctl = menelaus_ioctl,
1065 .read_time = menelaus_read_time,
1066 .set_time = menelaus_set_time,
1067 .read_alarm = menelaus_read_alarm,
1068 .set_alarm = menelaus_set_alarm,
1069 };
1070
1071 static void menelaus_rtc_alarm_work(struct menelaus_chip *m)
1072 {
1073 /* report alarm */
1074 rtc_update_irq(m->rtc, 1, RTC_IRQF | RTC_AF);
1075
1076 /* then disable it; alarms are oneshot */
1077 the_menelaus->rtc_control &= ~RTC_CTRL_AL_EN;
1078 menelaus_write_reg(MENELAUS_RTC_CTRL, the_menelaus->rtc_control);
1079 }
1080
1081 static inline void menelaus_rtc_init(struct menelaus_chip *m)
1082 {
1083 int alarm = (m->client->irq > 0);
1084 int err;
1085
1086 /* assume 32KDETEN pin is pulled high */
1087 if (!(menelaus_read_reg(MENELAUS_OSC_CTRL) & 0x80)) {
1088 dev_dbg(&m->client->dev, "no 32k oscillator\n");
1089 return;
1090 }
1091
1092 m->rtc = devm_rtc_allocate_device(&m->client->dev);
1093 if (IS_ERR(m->rtc))
1094 return;
1095
1096 m->rtc->ops = &menelaus_rtc_ops;
1097
1098 /* support RTC alarm; it can issue wakeups */
1099 if (alarm) {
1100 if (menelaus_add_irq_work(MENELAUS_RTCALM_IRQ,
1101 menelaus_rtc_alarm_work) < 0) {
1102 dev_err(&m->client->dev, "can't handle RTC alarm\n");
1103 return;
1104 }
1105 device_init_wakeup(&m->client->dev, 1);
1106 }
1107
1108 /* be sure RTC is enabled; allow 1/sec irqs; leave 12hr mode alone */
1109 m->rtc_control = menelaus_read_reg(MENELAUS_RTC_CTRL);
1110 if (!(m->rtc_control & RTC_CTRL_RTC_EN)
1111 || (m->rtc_control & RTC_CTRL_AL_EN)
1112 || (m->rtc_control & RTC_CTRL_EVERY_MASK)) {
1113 if (!(m->rtc_control & RTC_CTRL_RTC_EN)) {
1114 dev_warn(&m->client->dev, "rtc clock needs setting\n");
1115 m->rtc_control |= RTC_CTRL_RTC_EN;
1116 }
1117 m->rtc_control &= ~RTC_CTRL_EVERY_MASK;
1118 m->rtc_control &= ~RTC_CTRL_AL_EN;
1119 menelaus_write_reg(MENELAUS_RTC_CTRL, m->rtc_control);
1120 }
1121
1122 err = rtc_register_device(m->rtc);
1123 if (err) {
1124 if (alarm) {
1125 menelaus_remove_irq_work(MENELAUS_RTCALM_IRQ);
1126 device_init_wakeup(&m->client->dev, 0);
1127 }
1128 the_menelaus->rtc = NULL;
1129 }
1130 }
1131
1132 #else
1133
1134 static inline void menelaus_rtc_init(struct menelaus_chip *m)
1135 {
1136 /* nothing */
1137 }
1138
1139 #endif
1140
1141 /*-----------------------------------------------------------------------*/
1142
1143 static struct i2c_driver menelaus_i2c_driver;
1144
1145 static int menelaus_probe(struct i2c_client *client,
1146 const struct i2c_device_id *id)
1147 {
1148 struct menelaus_chip *menelaus;
1149 int rev = 0;
1150 int err = 0;
1151 struct menelaus_platform_data *menelaus_pdata =
1152 dev_get_platdata(&client->dev);
1153
1154 if (the_menelaus) {
1155 dev_dbg(&client->dev, "only one %s for now\n",
1156 DRIVER_NAME);
1157 return -ENODEV;
1158 }
1159
1160 menelaus = devm_kzalloc(&client->dev, sizeof(*menelaus), GFP_KERNEL);
1161 if (!menelaus)
1162 return -ENOMEM;
1163
1164 i2c_set_clientdata(client, menelaus);
1165
1166 the_menelaus = menelaus;
1167 menelaus->client = client;
1168
1169 /* If a true probe check the device */
1170 rev = menelaus_read_reg(MENELAUS_REV);
1171 if (rev < 0) {
1172 pr_err(DRIVER_NAME ": device not found");
1173 return -ENODEV;
1174 }
1175
1176 /* Ack and disable all Menelaus interrupts */
1177 menelaus_write_reg(MENELAUS_INT_ACK1, 0xff);
1178 menelaus_write_reg(MENELAUS_INT_ACK2, 0xff);
1179 menelaus_write_reg(MENELAUS_INT_MASK1, 0xff);
1180 menelaus_write_reg(MENELAUS_INT_MASK2, 0xff);
1181 menelaus->mask1 = 0xff;
1182 menelaus->mask2 = 0xff;
1183
1184 /* Set output buffer strengths */
1185 menelaus_write_reg(MENELAUS_MCT_CTRL1, 0x73);
1186
1187 if (client->irq > 0) {
1188 err = request_irq(client->irq, menelaus_irq, 0,
1189 DRIVER_NAME, menelaus);
1190 if (err) {
1191 dev_dbg(&client->dev, "can't get IRQ %d, err %d\n",
1192 client->irq, err);
1193 return err;
1194 }
1195 }
1196
1197 mutex_init(&menelaus->lock);
1198 INIT_WORK(&menelaus->work, menelaus_work);
1199
1200 pr_info("Menelaus rev %d.%d\n", rev >> 4, rev & 0x0f);
1201
1202 err = menelaus_read_reg(MENELAUS_VCORE_CTRL1);
1203 if (err < 0)
1204 goto fail;
1205 if (err & VCORE_CTRL1_HW_NSW)
1206 menelaus->vcore_hw_mode = 1;
1207 else
1208 menelaus->vcore_hw_mode = 0;
1209
1210 if (menelaus_pdata != NULL && menelaus_pdata->late_init != NULL) {
1211 err = menelaus_pdata->late_init(&client->dev);
1212 if (err < 0)
1213 goto fail;
1214 }
1215
1216 menelaus_rtc_init(menelaus);
1217
1218 return 0;
1219 fail:
1220 free_irq(client->irq, menelaus);
1221 flush_work(&menelaus->work);
1222 return err;
1223 }
1224
1225 static int menelaus_remove(struct i2c_client *client)
1226 {
1227 struct menelaus_chip *menelaus = i2c_get_clientdata(client);
1228
1229 free_irq(client->irq, menelaus);
1230 flush_work(&menelaus->work);
1231 the_menelaus = NULL;
1232 return 0;
1233 }
1234
1235 static const struct i2c_device_id menelaus_id[] = {
1236 { "menelaus", 0 },
1237 { }
1238 };
1239 MODULE_DEVICE_TABLE(i2c, menelaus_id);
1240
1241 static struct i2c_driver menelaus_i2c_driver = {
1242 .driver = {
1243 .name = DRIVER_NAME,
1244 },
1245 .probe = menelaus_probe,
1246 .remove = menelaus_remove,
1247 .id_table = menelaus_id,
1248 };
1249
1250 module_i2c_driver(menelaus_i2c_driver);
1251
1252 MODULE_AUTHOR("Texas Instruments, Inc. (and others)");
1253 MODULE_DESCRIPTION("I2C interface for Menelaus.");
1254 MODULE_LICENSE("GPL");
Linux with added FPC-III support