1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
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
102#define MENELAUS_MMC_S2CD_IRQ 1
103#define MENELAUS_MMC_S1D1_IRQ 2
104#define MENELAUS_MMC_S2D1_IRQ 3
105#define MENELAUS_LOWBAT_IRQ 4
106#define MENELAUS_HOTDIE_IRQ 5
107#define MENELAUS_UVLO_IRQ 6
108#define MENELAUS_TSHUT_IRQ 7
109#define MENELAUS_RTCTMR_IRQ 8
110#define MENELAUS_RTCALM_IRQ 9
111#define MENELAUS_RTCERR_IRQ 10
112#define MENELAUS_PSHBTN_IRQ 11
113#define MENELAUS_RESERVED12_IRQ 12
114#define MENELAUS_RESERVED13_IRQ 13
115#define MENELAUS_RESERVED14_IRQ 14
116#define MENELAUS_RESERVED15_IRQ 15
117
118
119#define VCORE_CTRL1_BYP_COMP (1 << 5)
120#define VCORE_CTRL1_HW_NSW (1 << 7)
121
122
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
130#define MCT_CTRL1_S1_CMD_OD (1 << 2)
131#define MCT_CTRL1_S2_CMD_OD (1 << 3)
132
133
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
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
148#define MCT_PIN_ST_S1_CD_ST (1 << 0)
149#define MCT_PIN_ST_S2_CD_ST (1 << 1)
150
151static void menelaus_work(struct work_struct *_menelaus);
152
153struct 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
169static struct menelaus_chip *the_menelaus;
170
171static 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
183static 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
193static 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
207static 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
221static 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
230static 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
244static 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
258
259
260
261
262static 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
284
285int 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}
314EXPORT_SYMBOL(menelaus_set_mmc_opendrain);
315
316int 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);
330out:
331 mutex_unlock(&the_menelaus->lock);
332 return ret;
333}
334EXPORT_SYMBOL(menelaus_set_slot_sel);
335
336int 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
390 val &= ~(MCT_CTRL3_S1_AUTO_EN | MCT_CTRL3_S2_AUTO_EN);
391 ret = menelaus_write_reg(MENELAUS_MCT_CTRL3, val);
392out:
393 mutex_unlock(&the_menelaus->lock);
394 return ret;
395}
396EXPORT_SYMBOL(menelaus_set_mmc_slot);
397
398int 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}
422EXPORT_SYMBOL(menelaus_register_mmc_callback);
423
424void 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}
434EXPORT_SYMBOL(menelaus_unregister_mmc_callback);
435
436struct menelaus_vtg {
437 const char *name;
438 u8 vtg_reg;
439 u8 vtg_shift;
440 u8 vtg_bits;
441 u8 mode_reg;
442};
443
444struct menelaus_vtg_value {
445 u16 vtg;
446 u16 val;
447};
448
449static 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);
471out:
472 mutex_unlock(&the_menelaus->lock);
473 if (ret == 0) {
474
475 msleep(1);
476 }
477 return ret;
478}
479
480static 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
493
494
495
496
497
498
499
500static 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
522int 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
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);
554out:
555 mutex_unlock(&the_menelaus->lock);
556 return ret;
557}
558
559static 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
567static const struct menelaus_vtg_value vmem_values[] = {
568 { 1500, 0 },
569 { 1800, 1 },
570 { 1900, 2 },
571 { 2500, 3 },
572};
573
574int 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}
586EXPORT_SYMBOL(menelaus_set_vmem);
587
588static 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
596static const struct menelaus_vtg_value vio_values[] = {
597 { 1500, 0 },
598 { 1800, 1 },
599 { 2500, 2 },
600 { 2800, 3 },
601};
602
603int 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}
615EXPORT_SYMBOL(menelaus_set_vio);
616
617static 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
628static 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
636static 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
644int 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
666static const struct menelaus_vtg_value vmmc_values[] = {
667 { 1850, 0 },
668 { 2800, 1 },
669 { 3000, 2 },
670 { 3100, 3 },
671};
672
673static 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
681int 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}
693EXPORT_SYMBOL(menelaus_set_vmmc);
694
695
696static const struct menelaus_vtg_value vaux_values[] = {
697 { 1500, 0 },
698 { 1800, 1 },
699 { 2500, 2 },
700 { 2800, 3 },
701};
702
703static 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
711int 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}
723EXPORT_SYMBOL(menelaus_set_vaux);
724
725int menelaus_get_slot_pin_states(void)
726{
727 return menelaus_read_reg(MENELAUS_MCT_PIN_ST);
728}
729EXPORT_SYMBOL(menelaus_get_slot_pin_states);
730
731int 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);
752out:
753 mutex_unlock(&the_menelaus->lock);
754 return ret;
755}
756
757
758
759
760static 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
795
796static 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
810
811
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
828static 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
843static 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;
880fail:
881 dev_err(&the_menelaus->client->dev, "rtc write reg %02x, err %d\n",
882 --regnum, status);
883 return status;
884}
885
886static 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
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
917static int menelaus_set_time(struct device *dev, struct rtc_time *t)
918{
919 int status;
920
921
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
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
941static 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
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
971 w->pending = 0;
972
973 return 0;
974}
975
976static 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
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
993 status = time_to_menelaus(&w->time, MENELAUS_RTC_AL_SEC);
994 if (status < 0)
995 return status;
996
997
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
1009static void menelaus_rtc_update_work(struct menelaus_chip *m)
1010{
1011
1012 rtc_update_irq(m->rtc, 1, RTC_IRQF | RTC_UF);
1013}
1014
1015static 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
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
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
1062
1063static 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
1071static void menelaus_rtc_alarm_work(struct menelaus_chip *m)
1072{
1073
1074 rtc_update_irq(m->rtc, 1, RTC_IRQF | RTC_AF);
1075
1076
1077 the_menelaus->rtc_control &= ~RTC_CTRL_AL_EN;
1078 menelaus_write_reg(MENELAUS_RTC_CTRL, the_menelaus->rtc_control);
1079}
1080
1081static inline void menelaus_rtc_init(struct menelaus_chip *m)
1082{
1083 int alarm = (m->client->irq > 0);
1084 int err;
1085
1086
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
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
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
1134static inline void menelaus_rtc_init(struct menelaus_chip *m)
1135{
1136
1137}
1138
1139#endif
1140
1141
1142
1143static struct i2c_driver menelaus_i2c_driver;
1144
1145static 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
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
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
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;
1219fail:
1220 free_irq(client->irq, menelaus);
1221 flush_work(&menelaus->work);
1222 return err;
1223}
1224
1225static 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
1235static const struct i2c_device_id menelaus_id[] = {
1236 { "menelaus", 0 },
1237 { }
1238};
1239MODULE_DEVICE_TABLE(i2c, menelaus_id);
1240
1241static 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
1250module_i2c_driver(menelaus_i2c_driver);
1251
1252MODULE_AUTHOR("Texas Instruments, Inc. (and others)");
1253MODULE_DESCRIPTION("I2C interface for Menelaus.");
1254MODULE_LICENSE("GPL");
1255
