2 * Copyright (C) 2004 Texas Instruments, Inc.
4 * Some parts based tps65010.c:
5 * Copyright (C) 2004 Texas Instruments and
6 * Copyright (C) 2004-2005 David Brownell
8 * Some parts based on tlv320aic24.c:
9 * Copyright (C) by Kai Svahn <kai.svahn@nokia.com>
11 * Changes for interrupt handling and clean-up by
12 * Tony Lindgren <tony@atomide.com> and Imre Deak <imre.deak@nokia.com>
13 * Cleanup and generalized support for voltage setting by
15 * Added support for controlling VCORE and regulator sleep states,
16 * Amit Kucheria <amit.kucheria@nokia.com>
17 * Copyright (C) 2005, 2006 Nokia Corporation
19 * This program is free software; you can redistribute it and/or modify
20 * it under the terms of the GNU General Public License as published by
21 * the Free Software Foundation; either version 2 of the License, or
22 * (at your option) any later version.
24 * This program is distributed in the hope that it will be useful,
25 * but WITHOUT ANY WARRANTY; without even the implied warranty of
26 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
27 * GNU General Public License for more details.
29 * You should have received a copy of the GNU General Public License
30 * along with this program; if not, write to the Free Software
31 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
34 #include <linux/module.h>
35 #include <linux/i2c.h>
36 #include <linux/interrupt.h>
37 #include <linux/sched.h>
38 #include <linux/mutex.h>
39 #include <linux/workqueue.h>
40 #include <linux/delay.h>
41 #include <linux/rtc.h>
42 #include <linux/bcd.h>
44 #include <asm/mach-types.h>
45 #include <asm/mach/irq.h>
47 #include <asm/arch/gpio.h>
48 #include <asm/arch/menelaus.h>
50 #define DRIVER_NAME "menelaus"
52 #define pr_err(fmt, arg...) printk(KERN_ERR DRIVER_NAME ": ", ## arg);
54 #define MENELAUS_I2C_ADDRESS 0x72
56 #define MENELAUS_REV 0x01
57 #define MENELAUS_VCORE_CTRL1 0x02
58 #define MENELAUS_VCORE_CTRL2 0x03
59 #define MENELAUS_VCORE_CTRL3 0x04
60 #define MENELAUS_VCORE_CTRL4 0x05
61 #define MENELAUS_VCORE_CTRL5 0x06
62 #define MENELAUS_DCDC_CTRL1 0x07
63 #define MENELAUS_DCDC_CTRL2 0x08
64 #define MENELAUS_DCDC_CTRL3 0x09
65 #define MENELAUS_LDO_CTRL1 0x0A
66 #define MENELAUS_LDO_CTRL2 0x0B
67 #define MENELAUS_LDO_CTRL3 0x0C
68 #define MENELAUS_LDO_CTRL4 0x0D
69 #define MENELAUS_LDO_CTRL5 0x0E
70 #define MENELAUS_LDO_CTRL6 0x0F
71 #define MENELAUS_LDO_CTRL7 0x10
72 #define MENELAUS_LDO_CTRL8 0x11
73 #define MENELAUS_SLEEP_CTRL1 0x12
74 #define MENELAUS_SLEEP_CTRL2 0x13
75 #define MENELAUS_DEVICE_OFF 0x14
76 #define MENELAUS_OSC_CTRL 0x15
77 #define MENELAUS_DETECT_CTRL 0x16
78 #define MENELAUS_INT_MASK1 0x17
79 #define MENELAUS_INT_MASK2 0x18
80 #define MENELAUS_INT_STATUS1 0x19
81 #define MENELAUS_INT_STATUS2 0x1A
82 #define MENELAUS_INT_ACK1 0x1B
83 #define MENELAUS_INT_ACK2 0x1C
84 #define MENELAUS_GPIO_CTRL 0x1D
85 #define MENELAUS_GPIO_IN 0x1E
86 #define MENELAUS_GPIO_OUT 0x1F
87 #define MENELAUS_BBSMS 0x20
88 #define MENELAUS_RTC_CTRL 0x21
89 #define MENELAUS_RTC_UPDATE 0x22
90 #define MENELAUS_RTC_SEC 0x23
91 #define MENELAUS_RTC_MIN 0x24
92 #define MENELAUS_RTC_HR 0x25
93 #define MENELAUS_RTC_DAY 0x26
94 #define MENELAUS_RTC_MON 0x27
95 #define MENELAUS_RTC_YR 0x28
96 #define MENELAUS_RTC_WKDAY 0x29
97 #define MENELAUS_RTC_AL_SEC 0x2A
98 #define MENELAUS_RTC_AL_MIN 0x2B
99 #define MENELAUS_RTC_AL_HR 0x2C
100 #define MENELAUS_RTC_AL_DAY 0x2D
101 #define MENELAUS_RTC_AL_MON 0x2E
102 #define MENELAUS_RTC_AL_YR 0x2F
103 #define MENELAUS_RTC_COMP_MSB 0x30
104 #define MENELAUS_RTC_COMP_LSB 0x31
105 #define MENELAUS_S1_PULL_EN 0x32
106 #define MENELAUS_S1_PULL_DIR 0x33
107 #define MENELAUS_S2_PULL_EN 0x34
108 #define MENELAUS_S2_PULL_DIR 0x35
109 #define MENELAUS_MCT_CTRL1 0x36
110 #define MENELAUS_MCT_CTRL2 0x37
111 #define MENELAUS_MCT_CTRL3 0x38
112 #define MENELAUS_MCT_PIN_ST 0x39
113 #define MENELAUS_DEBOUNCE1 0x3A
115 #define IH_MENELAUS_IRQS 12
116 #define MENELAUS_MMC_S1CD_IRQ 0 /* MMC slot 1 card change */
117 #define MENELAUS_MMC_S2CD_IRQ 1 /* MMC slot 2 card change */
118 #define MENELAUS_MMC_S1D1_IRQ 2 /* MMC DAT1 low in slot 1 */
119 #define MENELAUS_MMC_S2D1_IRQ 3 /* MMC DAT1 low in slot 2 */
120 #define MENELAUS_LOWBAT_IRQ 4 /* Low battery */
121 #define MENELAUS_HOTDIE_IRQ 5 /* Hot die detect */
122 #define MENELAUS_UVLO_IRQ 6 /* UVLO detect */
123 #define MENELAUS_TSHUT_IRQ 7 /* Thermal shutdown */
124 #define MENELAUS_RTCTMR_IRQ 8 /* RTC timer */
125 #define MENELAUS_RTCALM_IRQ 9 /* RTC alarm */
126 #define MENELAUS_RTCERR_IRQ 10 /* RTC error */
127 #define MENELAUS_PSHBTN_IRQ 11 /* Push button */
128 #define MENELAUS_RESERVED12_IRQ 12 /* Reserved */
129 #define MENELAUS_RESERVED13_IRQ 13 /* Reserved */
130 #define MENELAUS_RESERVED14_IRQ 14 /* Reserved */
131 #define MENELAUS_RESERVED15_IRQ 15 /* Reserved */
133 static void menelaus_work(struct work_struct
*_menelaus
);
135 struct menelaus_chip
{
137 struct i2c_client
*client
;
138 struct work_struct work
;
139 #ifdef CONFIG_RTC_DRV_TWL92330
140 struct rtc_device
*rtc
;
144 unsigned vcore_hw_mode
:1;
146 void (*handlers
[16])(struct menelaus_chip
*);
147 void (*mmc_callback
)(void *data
, u8 mask
);
148 void *mmc_callback_data
;
151 static struct menelaus_chip
*the_menelaus
;
153 static int menelaus_write_reg(int reg
, u8 value
)
155 int val
= i2c_smbus_write_byte_data(the_menelaus
->client
, reg
, value
);
158 pr_err("write error");
165 static int menelaus_read_reg(int reg
)
167 int val
= i2c_smbus_read_byte_data(the_menelaus
->client
, reg
);
170 pr_err("read error");
175 static int menelaus_enable_irq(int irq
)
179 the_menelaus
->mask2
&= ~(1 << irq
);
180 return menelaus_write_reg(MENELAUS_INT_MASK2
,
181 the_menelaus
->mask2
);
183 the_menelaus
->mask1
&= ~(1 << irq
);
184 return menelaus_write_reg(MENELAUS_INT_MASK1
,
185 the_menelaus
->mask1
);
189 static int menelaus_disable_irq(int irq
)
193 the_menelaus
->mask2
|= (1 << irq
);
194 return menelaus_write_reg(MENELAUS_INT_MASK2
,
195 the_menelaus
->mask2
);
197 the_menelaus
->mask1
|= (1 << irq
);
198 return menelaus_write_reg(MENELAUS_INT_MASK1
,
199 the_menelaus
->mask1
);
203 static int menelaus_ack_irq(int irq
)
206 return menelaus_write_reg(MENELAUS_INT_ACK2
, 1 << (irq
- 8));
208 return menelaus_write_reg(MENELAUS_INT_ACK1
, 1 << irq
);
211 /* Adds a handler for an interrupt. Does not run in interrupt context */
212 static int menelaus_add_irq_work(int irq
,
213 void (*handler
)(struct menelaus_chip
*))
217 mutex_lock(&the_menelaus
->lock
);
218 the_menelaus
->handlers
[irq
] = handler
;
219 ret
= menelaus_enable_irq(irq
);
220 mutex_unlock(&the_menelaus
->lock
);
225 /* Removes handler for an interrupt */
226 static int menelaus_remove_irq_work(int irq
)
230 mutex_lock(&the_menelaus
->lock
);
231 ret
= menelaus_disable_irq(irq
);
232 the_menelaus
->handlers
[irq
] = NULL
;
233 mutex_unlock(&the_menelaus
->lock
);
239 * Gets scheduled when a card detect interrupt happens. Note that in some cases
240 * this line is wired to card cover switch rather than the card detect switch
241 * in each slot. In this case the cards are not seen by menelaus.
242 * FIXME: Add handling for D1 too
244 static void menelaus_mmc_cd_work(struct menelaus_chip
*menelaus_hw
)
247 unsigned char card_mask
= 0;
249 reg
= menelaus_read_reg(MENELAUS_MCT_PIN_ST
);
254 card_mask
|= (1 << 0);
257 card_mask
|= (1 << 1);
259 if (menelaus_hw
->mmc_callback
)
260 menelaus_hw
->mmc_callback(menelaus_hw
->mmc_callback_data
,
265 * Toggles the MMC slots between open-drain and push-pull mode.
267 int menelaus_set_mmc_opendrain(int slot
, int enable
)
271 if (slot
!= 1 && slot
!= 2)
273 mutex_lock(&the_menelaus
->lock
);
274 ret
= menelaus_read_reg(MENELAUS_MCT_CTRL1
);
276 mutex_unlock(&the_menelaus
->lock
);
291 ret
= menelaus_write_reg(MENELAUS_MCT_CTRL1
, val
);
292 mutex_unlock(&the_menelaus
->lock
);
296 EXPORT_SYMBOL(menelaus_set_mmc_opendrain
);
298 int menelaus_set_slot_sel(int enable
)
302 mutex_lock(&the_menelaus
->lock
);
303 ret
= menelaus_read_reg(MENELAUS_GPIO_CTRL
);
311 ret
= menelaus_write_reg(MENELAUS_GPIO_CTRL
, ret
);
313 mutex_unlock(&the_menelaus
->lock
);
316 EXPORT_SYMBOL(menelaus_set_slot_sel
);
318 int menelaus_set_mmc_slot(int slot
, int enable
, int power
, int cd_en
)
322 if (slot
!= 1 && slot
!= 2)
327 mutex_lock(&the_menelaus
->lock
);
329 ret
= menelaus_read_reg(MENELAUS_MCT_CTRL2
);
335 val
|= (1 << 4) | (1 << 6);
337 val
&= ~((1 << 4) | (1 << 6));
340 val
|= (1 << 5) | (1 << 7);
342 val
&= ~((1 << 5) | (1 << 7));
344 ret
= menelaus_write_reg(MENELAUS_MCT_CTRL2
, val
);
348 ret
= menelaus_read_reg(MENELAUS_MCT_CTRL3
);
364 b
= menelaus_read_reg(MENELAUS_MCT_CTRL2
);
367 ret
= menelaus_write_reg(MENELAUS_MCT_CTRL2
, b
);
371 /* Disable autonomous shutdown */
373 ret
= menelaus_write_reg(MENELAUS_MCT_CTRL3
, val
);
375 mutex_unlock(&the_menelaus
->lock
);
378 EXPORT_SYMBOL(menelaus_set_mmc_slot
);
380 int menelaus_register_mmc_callback(void (*callback
)(void *data
, u8 card_mask
),
385 the_menelaus
->mmc_callback_data
= data
;
386 the_menelaus
->mmc_callback
= callback
;
387 ret
= menelaus_add_irq_work(MENELAUS_MMC_S1CD_IRQ
,
388 menelaus_mmc_cd_work
);
391 ret
= menelaus_add_irq_work(MENELAUS_MMC_S2CD_IRQ
,
392 menelaus_mmc_cd_work
);
395 ret
= menelaus_add_irq_work(MENELAUS_MMC_S1D1_IRQ
,
396 menelaus_mmc_cd_work
);
399 ret
= menelaus_add_irq_work(MENELAUS_MMC_S2D1_IRQ
,
400 menelaus_mmc_cd_work
);
404 EXPORT_SYMBOL(menelaus_register_mmc_callback
);
406 void menelaus_unregister_mmc_callback(void)
408 menelaus_remove_irq_work(MENELAUS_MMC_S1CD_IRQ
);
409 menelaus_remove_irq_work(MENELAUS_MMC_S2CD_IRQ
);
410 menelaus_remove_irq_work(MENELAUS_MMC_S1D1_IRQ
);
411 menelaus_remove_irq_work(MENELAUS_MMC_S2D1_IRQ
);
413 the_menelaus
->mmc_callback
= NULL
;
414 the_menelaus
->mmc_callback_data
= 0;
416 EXPORT_SYMBOL(menelaus_unregister_mmc_callback
);
418 struct menelaus_vtg
{
426 struct menelaus_vtg_value
{
431 static int menelaus_set_voltage(const struct menelaus_vtg
*vtg
, int mV
,
432 int vtg_val
, int mode
)
435 struct i2c_client
*c
= the_menelaus
->client
;
437 mutex_lock(&the_menelaus
->lock
);
441 ret
= menelaus_read_reg(vtg
->vtg_reg
);
444 val
= ret
& ~(((1 << vtg
->vtg_bits
) - 1) << vtg
->vtg_shift
);
445 val
|= vtg_val
<< vtg
->vtg_shift
;
447 dev_dbg(&c
->dev
, "Setting voltage '%s'"
448 "to %d mV (reg 0x%02x, val 0x%02x)\n",
449 vtg
->name
, mV
, vtg
->vtg_reg
, val
);
451 ret
= menelaus_write_reg(vtg
->vtg_reg
, val
);
455 ret
= menelaus_write_reg(vtg
->mode_reg
, mode
);
457 mutex_unlock(&the_menelaus
->lock
);
459 /* Wait for voltage to stabilize */
465 static int menelaus_get_vtg_value(int vtg
, const struct menelaus_vtg_value
*tbl
,
470 for (i
= 0; i
< n
; i
++, tbl
++)
477 * Vcore can be programmed in two ways:
478 * SW-controlled: Required voltage is programmed into VCORE_CTRL1
479 * HW-controlled: Required range (roof-floor) is programmed into VCORE_CTRL3
482 * Call correct 'set' function accordingly
485 static const struct menelaus_vtg_value vcore_values
[] = {
507 int menelaus_set_vcore_sw(unsigned int mV
)
510 struct i2c_client
*c
= the_menelaus
->client
;
512 val
= menelaus_get_vtg_value(mV
, vcore_values
,
513 ARRAY_SIZE(vcore_values
));
517 dev_dbg(&c
->dev
, "Setting VCORE to %d mV (val 0x%02x)\n", mV
, val
);
519 /* Set SW mode and the voltage in one go. */
520 mutex_lock(&the_menelaus
->lock
);
521 ret
= menelaus_write_reg(MENELAUS_VCORE_CTRL1
, val
);
523 the_menelaus
->vcore_hw_mode
= 0;
524 mutex_unlock(&the_menelaus
->lock
);
530 int menelaus_set_vcore_hw(unsigned int roof_mV
, unsigned int floor_mV
)
532 int fval
, rval
, val
, ret
;
533 struct i2c_client
*c
= the_menelaus
->client
;
535 rval
= menelaus_get_vtg_value(roof_mV
, vcore_values
,
536 ARRAY_SIZE(vcore_values
));
539 fval
= menelaus_get_vtg_value(floor_mV
, vcore_values
,
540 ARRAY_SIZE(vcore_values
));
544 dev_dbg(&c
->dev
, "Setting VCORE FLOOR to %d mV and ROOF to %d mV\n",
547 mutex_lock(&the_menelaus
->lock
);
548 ret
= menelaus_write_reg(MENELAUS_VCORE_CTRL3
, fval
);
551 ret
= menelaus_write_reg(MENELAUS_VCORE_CTRL4
, rval
);
554 if (!the_menelaus
->vcore_hw_mode
) {
555 val
= menelaus_read_reg(MENELAUS_VCORE_CTRL1
);
556 /* HW mode, turn OFF byte comparator */
557 val
|= ((1 << 7) | (1 << 5));
558 ret
= menelaus_write_reg(MENELAUS_VCORE_CTRL1
, val
);
559 the_menelaus
->vcore_hw_mode
= 1;
563 mutex_unlock(&the_menelaus
->lock
);
567 static const struct menelaus_vtg vmem_vtg
= {
569 .vtg_reg
= MENELAUS_LDO_CTRL1
,
572 .mode_reg
= MENELAUS_LDO_CTRL3
,
575 static const struct menelaus_vtg_value vmem_values
[] = {
582 int menelaus_set_vmem(unsigned int mV
)
587 return menelaus_set_voltage(&vmem_vtg
, 0, 0, 0);
589 val
= menelaus_get_vtg_value(mV
, vmem_values
, ARRAY_SIZE(vmem_values
));
592 return menelaus_set_voltage(&vmem_vtg
, mV
, val
, 0x02);
594 EXPORT_SYMBOL(menelaus_set_vmem
);
596 static const struct menelaus_vtg vio_vtg
= {
598 .vtg_reg
= MENELAUS_LDO_CTRL1
,
601 .mode_reg
= MENELAUS_LDO_CTRL4
,
604 static const struct menelaus_vtg_value vio_values
[] = {
611 int menelaus_set_vio(unsigned int mV
)
616 return menelaus_set_voltage(&vio_vtg
, 0, 0, 0);
618 val
= menelaus_get_vtg_value(mV
, vio_values
, ARRAY_SIZE(vio_values
));
621 return menelaus_set_voltage(&vio_vtg
, mV
, val
, 0x02);
623 EXPORT_SYMBOL(menelaus_set_vio
);
625 static const struct menelaus_vtg_value vdcdc_values
[] = {
636 static const struct menelaus_vtg vdcdc2_vtg
= {
638 .vtg_reg
= MENELAUS_DCDC_CTRL1
,
641 .mode_reg
= MENELAUS_DCDC_CTRL2
,
644 static const struct menelaus_vtg vdcdc3_vtg
= {
646 .vtg_reg
= MENELAUS_DCDC_CTRL1
,
649 .mode_reg
= MENELAUS_DCDC_CTRL3
,
652 int menelaus_set_vdcdc(int dcdc
, unsigned int mV
)
654 const struct menelaus_vtg
*vtg
;
657 if (dcdc
!= 2 && dcdc
!= 3)
665 return menelaus_set_voltage(vtg
, 0, 0, 0);
667 val
= menelaus_get_vtg_value(mV
, vdcdc_values
,
668 ARRAY_SIZE(vdcdc_values
));
671 return menelaus_set_voltage(vtg
, mV
, val
, 0x03);
674 static const struct menelaus_vtg_value vmmc_values
[] = {
681 static const struct menelaus_vtg vmmc_vtg
= {
683 .vtg_reg
= MENELAUS_LDO_CTRL1
,
686 .mode_reg
= MENELAUS_LDO_CTRL7
,
689 int menelaus_set_vmmc(unsigned int mV
)
694 return menelaus_set_voltage(&vmmc_vtg
, 0, 0, 0);
696 val
= menelaus_get_vtg_value(mV
, vmmc_values
, ARRAY_SIZE(vmmc_values
));
699 return menelaus_set_voltage(&vmmc_vtg
, mV
, val
, 0x02);
701 EXPORT_SYMBOL(menelaus_set_vmmc
);
704 static const struct menelaus_vtg_value vaux_values
[] = {
711 static const struct menelaus_vtg vaux_vtg
= {
713 .vtg_reg
= MENELAUS_LDO_CTRL1
,
716 .mode_reg
= MENELAUS_LDO_CTRL6
,
719 int menelaus_set_vaux(unsigned int mV
)
724 return menelaus_set_voltage(&vaux_vtg
, 0, 0, 0);
726 val
= menelaus_get_vtg_value(mV
, vaux_values
, ARRAY_SIZE(vaux_values
));
729 return menelaus_set_voltage(&vaux_vtg
, mV
, val
, 0x02);
731 EXPORT_SYMBOL(menelaus_set_vaux
);
733 int menelaus_get_slot_pin_states(void)
735 return menelaus_read_reg(MENELAUS_MCT_PIN_ST
);
737 EXPORT_SYMBOL(menelaus_get_slot_pin_states
);
739 int menelaus_set_regulator_sleep(int enable
, u32 val
)
742 struct i2c_client
*c
= the_menelaus
->client
;
744 mutex_lock(&the_menelaus
->lock
);
745 ret
= menelaus_write_reg(MENELAUS_SLEEP_CTRL2
, val
);
749 dev_dbg(&c
->dev
, "regulator sleep configuration: %02x\n", val
);
751 ret
= menelaus_read_reg(MENELAUS_GPIO_CTRL
);
754 t
= ((1 << 6) | 0x04);
759 ret
= menelaus_write_reg(MENELAUS_GPIO_CTRL
, ret
);
761 mutex_unlock(&the_menelaus
->lock
);
765 /*-----------------------------------------------------------------------*/
767 /* Handles Menelaus interrupts. Does not run in interrupt context */
768 static void menelaus_work(struct work_struct
*_menelaus
)
770 struct menelaus_chip
*menelaus
=
771 container_of(_menelaus
, struct menelaus_chip
, work
);
772 void (*handler
)(struct menelaus_chip
*menelaus
);
777 isr
= (menelaus_read_reg(MENELAUS_INT_STATUS2
)
778 & ~menelaus
->mask2
) << 8;
779 isr
|= menelaus_read_reg(MENELAUS_INT_STATUS1
)
785 int irq
= fls(isr
) - 1;
788 mutex_lock(&menelaus
->lock
);
789 menelaus_disable_irq(irq
);
790 menelaus_ack_irq(irq
);
791 handler
= menelaus
->handlers
[irq
];
794 menelaus_enable_irq(irq
);
795 mutex_unlock(&menelaus
->lock
);
798 enable_irq(menelaus
->client
->irq
);
802 * We cannot use I2C in interrupt context, so we just schedule work.
804 static irqreturn_t
menelaus_irq(int irq
, void *_menelaus
)
806 struct menelaus_chip
*menelaus
= _menelaus
;
808 disable_irq_nosync(irq
);
809 (void)schedule_work(&menelaus
->work
);
814 /*-----------------------------------------------------------------------*/
817 * The RTC needs to be set once, then it runs on backup battery power.
818 * It supports alarms, including system wake alarms (from some modes);
819 * and 1/second IRQs if requested.
821 #ifdef CONFIG_RTC_DRV_TWL92330
823 #define RTC_CTRL_RTC_EN (1 << 0)
824 #define RTC_CTRL_AL_EN (1 << 1)
825 #define RTC_CTRL_MODE12 (1 << 2)
826 #define RTC_CTRL_EVERY_MASK (3 << 3)
827 #define RTC_CTRL_EVERY_SEC (0 << 3)
828 #define RTC_CTRL_EVERY_MIN (1 << 3)
829 #define RTC_CTRL_EVERY_HR (2 << 3)
830 #define RTC_CTRL_EVERY_DAY (3 << 3)
832 #define RTC_UPDATE_EVERY 0x08
834 #define RTC_HR_PM (1 << 7)
836 static void menelaus_to_time(char *regs
, struct rtc_time
*t
)
838 t
->tm_sec
= BCD2BIN(regs
[0]);
839 t
->tm_min
= BCD2BIN(regs
[1]);
840 if (the_menelaus
->rtc_control
& RTC_CTRL_MODE12
) {
841 t
->tm_hour
= BCD2BIN(regs
[2] & 0x1f) - 1;
842 if (regs
[2] & RTC_HR_PM
)
845 t
->tm_hour
= BCD2BIN(regs
[2] & 0x3f);
846 t
->tm_mday
= BCD2BIN(regs
[3]);
847 t
->tm_mon
= BCD2BIN(regs
[4]) - 1;
848 t
->tm_year
= BCD2BIN(regs
[5]) + 100;
851 static int time_to_menelaus(struct rtc_time
*t
, int regnum
)
855 status
= menelaus_write_reg(regnum
++, BIN2BCD(t
->tm_sec
));
859 status
= menelaus_write_reg(regnum
++, BIN2BCD(t
->tm_min
));
863 if (the_menelaus
->rtc_control
& RTC_CTRL_MODE12
) {
864 hour
= t
->tm_hour
+ 1;
866 hour
= RTC_HR_PM
| BIN2BCD(hour
- 12);
868 hour
= BIN2BCD(hour
);
870 hour
= BIN2BCD(t
->tm_hour
);
871 status
= menelaus_write_reg(regnum
++, hour
);
875 status
= menelaus_write_reg(regnum
++, BIN2BCD(t
->tm_mday
));
879 status
= menelaus_write_reg(regnum
++, BIN2BCD(t
->tm_mon
+ 1));
883 status
= menelaus_write_reg(regnum
++, BIN2BCD(t
->tm_year
- 100));
889 dev_err(&the_menelaus
->client
->dev
, "rtc write reg %02x, err %d\n",
894 static int menelaus_read_time(struct device
*dev
, struct rtc_time
*t
)
896 struct i2c_msg msg
[2];
900 /* block read date and time registers */
901 regs
[0] = MENELAUS_RTC_SEC
;
903 msg
[0].addr
= MENELAUS_I2C_ADDRESS
;
908 msg
[1].addr
= MENELAUS_I2C_ADDRESS
;
909 msg
[1].flags
= I2C_M_RD
;
910 msg
[1].len
= sizeof(regs
);
913 status
= i2c_transfer(the_menelaus
->client
->adapter
, msg
, 2);
915 dev_err(dev
, "%s error %d\n", "read", status
);
919 menelaus_to_time(regs
, t
);
920 t
->tm_wday
= BCD2BIN(regs
[6]);
925 static int menelaus_set_time(struct device
*dev
, struct rtc_time
*t
)
929 /* write date and time registers */
930 status
= time_to_menelaus(t
, MENELAUS_RTC_SEC
);
933 status
= menelaus_write_reg(MENELAUS_RTC_WKDAY
, BIN2BCD(t
->tm_wday
));
935 dev_err(&the_menelaus
->client
->dev
, "rtc write reg %02x "
936 "err %d\n", MENELAUS_RTC_WKDAY
, status
);
940 /* now commit the write */
941 status
= menelaus_write_reg(MENELAUS_RTC_UPDATE
, RTC_UPDATE_EVERY
);
943 dev_err(&the_menelaus
->client
->dev
, "rtc commit time, err %d\n",
949 static int menelaus_read_alarm(struct device
*dev
, struct rtc_wkalrm
*w
)
951 struct i2c_msg msg
[2];
955 /* block read alarm registers */
956 regs
[0] = MENELAUS_RTC_AL_SEC
;
958 msg
[0].addr
= MENELAUS_I2C_ADDRESS
;
963 msg
[1].addr
= MENELAUS_I2C_ADDRESS
;
964 msg
[1].flags
= I2C_M_RD
;
965 msg
[1].len
= sizeof(regs
);
968 status
= i2c_transfer(the_menelaus
->client
->adapter
, msg
, 2);
970 dev_err(dev
, "%s error %d\n", "alarm read", status
);
974 menelaus_to_time(regs
, &w
->time
);
976 w
->enabled
= !!(the_menelaus
->rtc_control
& RTC_CTRL_AL_EN
);
978 /* NOTE we *could* check if actually pending... */
984 static int menelaus_set_alarm(struct device
*dev
, struct rtc_wkalrm
*w
)
988 if (the_menelaus
->client
->irq
<= 0 && w
->enabled
)
991 /* clear previous alarm enable */
992 if (the_menelaus
->rtc_control
& RTC_CTRL_AL_EN
) {
993 the_menelaus
->rtc_control
&= ~RTC_CTRL_AL_EN
;
994 status
= menelaus_write_reg(MENELAUS_RTC_CTRL
,
995 the_menelaus
->rtc_control
);
1000 /* write alarm registers */
1001 status
= time_to_menelaus(&w
->time
, MENELAUS_RTC_AL_SEC
);
1005 /* enable alarm if requested */
1007 the_menelaus
->rtc_control
|= RTC_CTRL_AL_EN
;
1008 status
= menelaus_write_reg(MENELAUS_RTC_CTRL
,
1009 the_menelaus
->rtc_control
);
1015 #ifdef CONFIG_RTC_INTF_DEV
1017 static void menelaus_rtc_update_work(struct menelaus_chip
*m
)
1019 /* report 1/sec update */
1020 local_irq_disable();
1021 rtc_update_irq(m
->rtc
, 1, RTC_IRQF
| RTC_UF
);
1025 static int menelaus_ioctl(struct device
*dev
, unsigned cmd
, unsigned long arg
)
1029 if (the_menelaus
->client
->irq
<= 0)
1030 return -ENOIOCTLCMD
;
1035 if (the_menelaus
->rtc_control
& RTC_CTRL_AL_EN
)
1037 the_menelaus
->rtc_control
|= RTC_CTRL_AL_EN
;
1040 if (!(the_menelaus
->rtc_control
& RTC_CTRL_AL_EN
))
1042 the_menelaus
->rtc_control
&= ~RTC_CTRL_AL_EN
;
1044 /* 1/second "update" IRQ */
1046 if (the_menelaus
->uie
)
1048 status
= menelaus_remove_irq_work(MENELAUS_RTCTMR_IRQ
);
1049 status
= menelaus_add_irq_work(MENELAUS_RTCTMR_IRQ
,
1050 menelaus_rtc_update_work
);
1052 the_menelaus
->uie
= 1;
1055 if (!the_menelaus
->uie
)
1057 status
= menelaus_remove_irq_work(MENELAUS_RTCTMR_IRQ
);
1059 the_menelaus
->uie
= 0;
1062 return -ENOIOCTLCMD
;
1064 return menelaus_write_reg(MENELAUS_RTC_CTRL
, the_menelaus
->rtc_control
);
1068 #define menelaus_ioctl NULL
1071 /* REVISIT no compensation register support ... */
1073 static const struct rtc_class_ops menelaus_rtc_ops
= {
1074 .ioctl
= menelaus_ioctl
,
1075 .read_time
= menelaus_read_time
,
1076 .set_time
= menelaus_set_time
,
1077 .read_alarm
= menelaus_read_alarm
,
1078 .set_alarm
= menelaus_set_alarm
,
1081 static void menelaus_rtc_alarm_work(struct menelaus_chip
*m
)
1084 local_irq_disable();
1085 rtc_update_irq(m
->rtc
, 1, RTC_IRQF
| RTC_AF
);
1088 /* then disable it; alarms are oneshot */
1089 the_menelaus
->rtc_control
&= ~RTC_CTRL_AL_EN
;
1090 menelaus_write_reg(MENELAUS_RTC_CTRL
, the_menelaus
->rtc_control
);
1093 static inline void menelaus_rtc_init(struct menelaus_chip
*m
)
1095 int alarm
= (m
->client
->irq
> 0);
1097 /* assume 32KDETEN pin is pulled high */
1098 if (!(menelaus_read_reg(MENELAUS_OSC_CTRL
) & 0x80)) {
1099 dev_dbg(&m
->client
->dev
, "no 32k oscillator\n");
1103 /* support RTC alarm; it can issue wakeups */
1105 if (menelaus_add_irq_work(MENELAUS_RTCALM_IRQ
,
1106 menelaus_rtc_alarm_work
) < 0) {
1107 dev_err(&m
->client
->dev
, "can't handle RTC alarm\n");
1110 device_init_wakeup(&m
->client
->dev
, 1);
1113 /* be sure RTC is enabled; allow 1/sec irqs; leave 12hr mode alone */
1114 m
->rtc_control
= menelaus_read_reg(MENELAUS_RTC_CTRL
);
1115 if (!(m
->rtc_control
& RTC_CTRL_RTC_EN
)
1116 || (m
->rtc_control
& RTC_CTRL_AL_EN
)
1117 || (m
->rtc_control
& RTC_CTRL_EVERY_MASK
)) {
1118 if (!(m
->rtc_control
& RTC_CTRL_RTC_EN
)) {
1119 dev_warn(&m
->client
->dev
, "rtc clock needs setting\n");
1120 m
->rtc_control
|= RTC_CTRL_RTC_EN
;
1122 m
->rtc_control
&= ~RTC_CTRL_EVERY_MASK
;
1123 m
->rtc_control
&= ~RTC_CTRL_AL_EN
;
1124 menelaus_write_reg(MENELAUS_RTC_CTRL
, m
->rtc_control
);
1127 m
->rtc
= rtc_device_register(DRIVER_NAME
,
1129 &menelaus_rtc_ops
, THIS_MODULE
);
1130 if (IS_ERR(m
->rtc
)) {
1132 menelaus_remove_irq_work(MENELAUS_RTCALM_IRQ
);
1133 device_init_wakeup(&m
->client
->dev
, 0);
1135 dev_err(&m
->client
->dev
, "can't register RTC: %d\n",
1136 (int) PTR_ERR(m
->rtc
));
1137 the_menelaus
->rtc
= NULL
;
1143 static inline void menelaus_rtc_init(struct menelaus_chip
*m
)
1150 /*-----------------------------------------------------------------------*/
1152 static struct i2c_driver menelaus_i2c_driver
;
1154 static int menelaus_probe(struct i2c_client
*client
)
1156 struct menelaus_chip
*menelaus
;
1159 struct menelaus_platform_data
*menelaus_pdata
=
1160 client
->dev
.platform_data
;
1163 dev_dbg(&client
->dev
, "only one %s for now\n",
1168 menelaus
= kzalloc(sizeof *menelaus
, GFP_KERNEL
);
1172 i2c_set_clientdata(client
, menelaus
);
1174 the_menelaus
= menelaus
;
1175 menelaus
->client
= client
;
1177 /* If a true probe check the device */
1178 rev
= menelaus_read_reg(MENELAUS_REV
);
1180 pr_err("device not found");
1185 /* Ack and disable all Menelaus interrupts */
1186 menelaus_write_reg(MENELAUS_INT_ACK1
, 0xff);
1187 menelaus_write_reg(MENELAUS_INT_ACK2
, 0xff);
1188 menelaus_write_reg(MENELAUS_INT_MASK1
, 0xff);
1189 menelaus_write_reg(MENELAUS_INT_MASK2
, 0xff);
1190 menelaus
->mask1
= 0xff;
1191 menelaus
->mask2
= 0xff;
1193 /* Set output buffer strengths */
1194 menelaus_write_reg(MENELAUS_MCT_CTRL1
, 0x73);
1196 if (client
->irq
> 0) {
1197 err
= request_irq(client
->irq
, menelaus_irq
, IRQF_DISABLED
,
1198 DRIVER_NAME
, menelaus
);
1200 dev_dbg(&client
->dev
, "can't get IRQ %d, err %d",
1206 mutex_init(&menelaus
->lock
);
1207 INIT_WORK(&menelaus
->work
, menelaus_work
);
1209 pr_info("Menelaus rev %d.%d\n", rev
>> 4, rev
& 0x0f);
1211 val
= menelaus_read_reg(MENELAUS_VCORE_CTRL1
);
1215 menelaus
->vcore_hw_mode
= 1;
1217 menelaus
->vcore_hw_mode
= 0;
1219 if (menelaus_pdata
!= NULL
&& menelaus_pdata
->late_init
!= NULL
) {
1220 err
= menelaus_pdata
->late_init(&client
->dev
);
1225 menelaus_rtc_init(menelaus
);
1229 free_irq(client
->irq
, menelaus
);
1230 flush_scheduled_work();
1236 static int __exit
menelaus_remove(struct i2c_client
*client
)
1238 struct menelaus_chip
*menelaus
= i2c_get_clientdata(client
);
1240 free_irq(client
->irq
, menelaus
);
1242 i2c_set_clientdata(client
, NULL
);
1243 the_menelaus
= NULL
;
1247 static struct i2c_driver menelaus_i2c_driver
= {
1249 .name
= DRIVER_NAME
,
1251 .probe
= menelaus_probe
,
1252 .remove
= __exit_p(menelaus_remove
),
1255 static int __init
menelaus_init(void)
1259 res
= i2c_add_driver(&menelaus_i2c_driver
);
1261 pr_err("driver registration failed\n");
1268 static void __exit
menelaus_exit(void)
1270 i2c_del_driver(&menelaus_i2c_driver
);
1272 /* FIXME: Shutdown menelaus parts that can be shut down */
1275 MODULE_AUTHOR("Texas Instruments, Inc. (and others)");
1276 MODULE_DESCRIPTION("I2C interface for Menelaus.");
1277 MODULE_LICENSE("GPL");
1279 module_init(menelaus_init
);
1280 module_exit(menelaus_exit
);