3 * Copyright (C) 2004 Texas Instruments, Inc.
5 * Some parts based tps65010.c:
6 * Copyright (C) 2004 Texas Instruments and
7 * Copyright (C) 2004-2005 David Brownell
9 * Some parts based on tlv320aic24.c:
10 * Copyright (C) by Kai Svahn <kai.svahn@nokia.com>
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
16 * Added support for controlling VCORE and regulator sleep states,
17 * Amit Kucheria <amit.kucheria@nokia.com>
18 * Copyright (C) 2005, 2006 Nokia Corporation
20 * This program is free software; you can redistribute it and/or modify
21 * it under the terms of the GNU General Public License as published by
22 * the Free Software Foundation; either version 2 of the License, or
23 * (at your option) any later version.
25 * This program is distributed in the hope that it will be useful,
26 * but WITHOUT ANY WARRANTY; without even the implied warranty of
27 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
28 * GNU General Public License for more details.
30 * You should have received a copy of the GNU General Public License
31 * along with this program; if not, write to the Free Software
32 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
35 #include <linux/module.h>
36 #include <linux/i2c.h>
37 #include <linux/interrupt.h>
38 #include <linux/sched.h>
39 #include <linux/mutex.h>
40 #include <linux/workqueue.h>
41 #include <linux/delay.h>
42 #include <linux/rtc.h>
43 #include <linux/bcd.h>
45 #include <asm/mach-types.h>
46 #include <asm/mach/irq.h>
48 #include <asm/arch/gpio.h>
49 #include <asm/arch/menelaus.h>
51 #define DRIVER_NAME "menelaus"
53 #define MENELAUS_I2C_ADDRESS 0x72
55 #define MENELAUS_REV 0x01
56 #define MENELAUS_VCORE_CTRL1 0x02
57 #define MENELAUS_VCORE_CTRL2 0x03
58 #define MENELAUS_VCORE_CTRL3 0x04
59 #define MENELAUS_VCORE_CTRL4 0x05
60 #define MENELAUS_VCORE_CTRL5 0x06
61 #define MENELAUS_DCDC_CTRL1 0x07
62 #define MENELAUS_DCDC_CTRL2 0x08
63 #define MENELAUS_DCDC_CTRL3 0x09
64 #define MENELAUS_LDO_CTRL1 0x0A
65 #define MENELAUS_LDO_CTRL2 0x0B
66 #define MENELAUS_LDO_CTRL3 0x0C
67 #define MENELAUS_LDO_CTRL4 0x0D
68 #define MENELAUS_LDO_CTRL5 0x0E
69 #define MENELAUS_LDO_CTRL6 0x0F
70 #define MENELAUS_LDO_CTRL7 0x10
71 #define MENELAUS_LDO_CTRL8 0x11
72 #define MENELAUS_SLEEP_CTRL1 0x12
73 #define MENELAUS_SLEEP_CTRL2 0x13
74 #define MENELAUS_DEVICE_OFF 0x14
75 #define MENELAUS_OSC_CTRL 0x15
76 #define MENELAUS_DETECT_CTRL 0x16
77 #define MENELAUS_INT_MASK1 0x17
78 #define MENELAUS_INT_MASK2 0x18
79 #define MENELAUS_INT_STATUS1 0x19
80 #define MENELAUS_INT_STATUS2 0x1A
81 #define MENELAUS_INT_ACK1 0x1B
82 #define MENELAUS_INT_ACK2 0x1C
83 #define MENELAUS_GPIO_CTRL 0x1D
84 #define MENELAUS_GPIO_IN 0x1E
85 #define MENELAUS_GPIO_OUT 0x1F
86 #define MENELAUS_BBSMS 0x20
87 #define MENELAUS_RTC_CTRL 0x21
88 #define MENELAUS_RTC_UPDATE 0x22
89 #define MENELAUS_RTC_SEC 0x23
90 #define MENELAUS_RTC_MIN 0x24
91 #define MENELAUS_RTC_HR 0x25
92 #define MENELAUS_RTC_DAY 0x26
93 #define MENELAUS_RTC_MON 0x27
94 #define MENELAUS_RTC_YR 0x28
95 #define MENELAUS_RTC_WKDAY 0x29
96 #define MENELAUS_RTC_AL_SEC 0x2A
97 #define MENELAUS_RTC_AL_MIN 0x2B
98 #define MENELAUS_RTC_AL_HR 0x2C
99 #define MENELAUS_RTC_AL_DAY 0x2D
100 #define MENELAUS_RTC_AL_MON 0x2E
101 #define MENELAUS_RTC_AL_YR 0x2F
102 #define MENELAUS_RTC_COMP_MSB 0x30
103 #define MENELAUS_RTC_COMP_LSB 0x31
104 #define MENELAUS_S1_PULL_EN 0x32
105 #define MENELAUS_S1_PULL_DIR 0x33
106 #define MENELAUS_S2_PULL_EN 0x34
107 #define MENELAUS_S2_PULL_DIR 0x35
108 #define MENELAUS_MCT_CTRL1 0x36
109 #define MENELAUS_MCT_CTRL2 0x37
110 #define MENELAUS_MCT_CTRL3 0x38
111 #define MENELAUS_MCT_PIN_ST 0x39
112 #define MENELAUS_DEBOUNCE1 0x3A
114 #define IH_MENELAUS_IRQS 12
115 #define MENELAUS_MMC_S1CD_IRQ 0 /* MMC slot 1 card change */
116 #define MENELAUS_MMC_S2CD_IRQ 1 /* MMC slot 2 card change */
117 #define MENELAUS_MMC_S1D1_IRQ 2 /* MMC DAT1 low in slot 1 */
118 #define MENELAUS_MMC_S2D1_IRQ 3 /* MMC DAT1 low in slot 2 */
119 #define MENELAUS_LOWBAT_IRQ 4 /* Low battery */
120 #define MENELAUS_HOTDIE_IRQ 5 /* Hot die detect */
121 #define MENELAUS_UVLO_IRQ 6 /* UVLO detect */
122 #define MENELAUS_TSHUT_IRQ 7 /* Thermal shutdown */
123 #define MENELAUS_RTCTMR_IRQ 8 /* RTC timer */
124 #define MENELAUS_RTCALM_IRQ 9 /* RTC alarm */
125 #define MENELAUS_RTCERR_IRQ 10 /* RTC error */
126 #define MENELAUS_PSHBTN_IRQ 11 /* Push button */
127 #define MENELAUS_RESERVED12_IRQ 12 /* Reserved */
128 #define MENELAUS_RESERVED13_IRQ 13 /* Reserved */
129 #define MENELAUS_RESERVED14_IRQ 14 /* Reserved */
130 #define MENELAUS_RESERVED15_IRQ 15 /* Reserved */
132 static void menelaus_work(struct work_struct *_menelaus);
134 struct menelaus_chip {
136 struct i2c_client *client;
137 struct work_struct work;
138 #ifdef CONFIG_RTC_DRV_TWL92330
139 struct rtc_device *rtc;
143 unsigned vcore_hw_mode:1;
145 void (*handlers[16])(struct menelaus_chip *);
146 void (*mmc_callback)(void *data, u8 mask);
147 void *mmc_callback_data;
150 static struct menelaus_chip *the_menelaus;
152 static int menelaus_write_reg(int reg, u8 value)
154 int val = i2c_smbus_write_byte_data(the_menelaus->client, reg, value);
157 dev_err(&the_menelaus->client->dev, "write error");
164 static int menelaus_read_reg(int reg)
166 int val = i2c_smbus_read_byte_data(the_menelaus->client, reg);
169 dev_err(&the_menelaus->client->dev, "read error");
174 static int menelaus_enable_irq(int irq)
178 the_menelaus->mask2 &= ~(1 << irq);
179 return menelaus_write_reg(MENELAUS_INT_MASK2,
180 the_menelaus->mask2);
182 the_menelaus->mask1 &= ~(1 << irq);
183 return menelaus_write_reg(MENELAUS_INT_MASK1,
184 the_menelaus->mask1);
188 static int menelaus_disable_irq(int irq)
192 the_menelaus->mask2 |= (1 << irq);
193 return menelaus_write_reg(MENELAUS_INT_MASK2,
194 the_menelaus->mask2);
196 the_menelaus->mask1 |= (1 << irq);
197 return menelaus_write_reg(MENELAUS_INT_MASK1,
198 the_menelaus->mask1);
202 static int menelaus_ack_irq(int irq)
205 return menelaus_write_reg(MENELAUS_INT_ACK2, 1 << (irq - 8));
207 return menelaus_write_reg(MENELAUS_INT_ACK1, 1 << irq);
210 /* Adds a handler for an interrupt. Does not run in interrupt context */
211 static int menelaus_add_irq_work(int irq,
212 void (*handler)(struct menelaus_chip *))
216 mutex_lock(&the_menelaus->lock);
217 the_menelaus->handlers[irq] = handler;
218 ret = menelaus_enable_irq(irq);
219 mutex_unlock(&the_menelaus->lock);
224 /* Removes handler for an interrupt */
225 static int menelaus_remove_irq_work(int irq)
229 mutex_lock(&the_menelaus->lock);
230 ret = menelaus_disable_irq(irq);
231 the_menelaus->handlers[irq] = NULL;
232 mutex_unlock(&the_menelaus->lock);
238 * Gets scheduled when a card detect interrupt happens. Note that in some cases
239 * this line is wired to card cover switch rather than the card detect switch
240 * in each slot. In this case the cards are not seen by menelaus.
241 * FIXME: Add handling for D1 too
243 static void menelaus_mmc_cd_work(struct menelaus_chip *menelaus_hw)
246 unsigned char card_mask = 0;
248 reg = menelaus_read_reg(MENELAUS_MCT_PIN_ST);
253 card_mask |= (1 << 0);
256 card_mask |= (1 << 1);
258 if (menelaus_hw->mmc_callback)
259 menelaus_hw->mmc_callback(menelaus_hw->mmc_callback_data,
264 * Toggles the MMC slots between open-drain and push-pull mode.
266 int menelaus_set_mmc_opendrain(int slot, int enable)
270 if (slot != 1 && slot != 2)
272 mutex_lock(&the_menelaus->lock);
273 ret = menelaus_read_reg(MENELAUS_MCT_CTRL1);
275 mutex_unlock(&the_menelaus->lock);
290 ret = menelaus_write_reg(MENELAUS_MCT_CTRL1, val);
291 mutex_unlock(&the_menelaus->lock);
295 EXPORT_SYMBOL(menelaus_set_mmc_opendrain);
297 int menelaus_set_slot_sel(int enable)
301 mutex_lock(&the_menelaus->lock);
302 ret = menelaus_read_reg(MENELAUS_GPIO_CTRL);
310 ret = menelaus_write_reg(MENELAUS_GPIO_CTRL, ret);
312 mutex_unlock(&the_menelaus->lock);
315 EXPORT_SYMBOL(menelaus_set_slot_sel);
317 int menelaus_enable_slot(int slot, int enable)
321 mutex_lock(&the_menelaus->lock);
322 ret = menelaus_read_reg(MENELAUS_MCT_CTRL3);
337 ret = menelaus_write_reg(MENELAUS_MCT_CTRL3, val);
340 mutex_unlock(&the_menelaus->lock);
343 EXPORT_SYMBOL(menelaus_enable_slot);
345 int menelaus_set_mmc_slot(int slot, int enable, int power, int cd_en)
349 if (slot != 1 && slot != 2)
354 mutex_lock(&the_menelaus->lock);
356 ret = menelaus_read_reg(MENELAUS_MCT_CTRL2);
362 val |= (1 << 4) | (1 << 6);
364 val &= ~((1 << 4) | (1 << 6));
367 val |= (1 << 5) | (1 << 7);
369 val &= ~((1 << 5) | (1 << 7));
371 ret = menelaus_write_reg(MENELAUS_MCT_CTRL2, val);
375 ret = menelaus_read_reg(MENELAUS_MCT_CTRL3);
391 b = menelaus_read_reg(MENELAUS_MCT_CTRL2);
394 ret = menelaus_write_reg(MENELAUS_MCT_CTRL2, b);
398 /* Disable autonomous shutdown */
400 ret = menelaus_write_reg(MENELAUS_MCT_CTRL3, val);
402 mutex_unlock(&the_menelaus->lock);
405 EXPORT_SYMBOL(menelaus_set_mmc_slot);
407 int menelaus_register_mmc_callback(void (*callback)(void *data, u8 card_mask),
412 the_menelaus->mmc_callback_data = data;
413 the_menelaus->mmc_callback = callback;
414 ret = menelaus_add_irq_work(MENELAUS_MMC_S1CD_IRQ,
415 menelaus_mmc_cd_work);
418 ret = menelaus_add_irq_work(MENELAUS_MMC_S2CD_IRQ,
419 menelaus_mmc_cd_work);
422 ret = menelaus_add_irq_work(MENELAUS_MMC_S1D1_IRQ,
423 menelaus_mmc_cd_work);
426 ret = menelaus_add_irq_work(MENELAUS_MMC_S2D1_IRQ,
427 menelaus_mmc_cd_work);
431 EXPORT_SYMBOL(menelaus_register_mmc_callback);
433 void menelaus_unregister_mmc_callback(void)
435 menelaus_remove_irq_work(MENELAUS_MMC_S1CD_IRQ);
436 menelaus_remove_irq_work(MENELAUS_MMC_S2CD_IRQ);
437 menelaus_remove_irq_work(MENELAUS_MMC_S1D1_IRQ);
438 menelaus_remove_irq_work(MENELAUS_MMC_S2D1_IRQ);
440 the_menelaus->mmc_callback = NULL;
441 the_menelaus->mmc_callback_data = 0;
443 EXPORT_SYMBOL(menelaus_unregister_mmc_callback);
445 struct menelaus_vtg {
453 struct menelaus_vtg_value {
458 static int menelaus_set_voltage(const struct menelaus_vtg *vtg, int mV,
459 int vtg_val, int mode)
462 struct i2c_client *c = the_menelaus->client;
464 mutex_lock(&the_menelaus->lock);
468 ret = menelaus_read_reg(vtg->vtg_reg);
471 val = ret & ~(((1 << vtg->vtg_bits) - 1) << vtg->vtg_shift);
472 val |= vtg_val << vtg->vtg_shift;
474 dev_dbg(&c->dev, "Setting voltage '%s'"
475 "to %d mV (reg 0x%02x, val 0x%02x)\n",
476 vtg->name, mV, vtg->vtg_reg, val);
478 ret = menelaus_write_reg(vtg->vtg_reg, val);
482 ret = menelaus_write_reg(vtg->mode_reg, mode);
484 mutex_unlock(&the_menelaus->lock);
486 /* Wait for voltage to stabilize */
492 static int menelaus_get_vtg_value(int vtg, const struct menelaus_vtg_value *tbl,
497 for (i = 0; i < n; i++, tbl++)
504 * Vcore can be programmed in two ways:
505 * SW-controlled: Required voltage is programmed into VCORE_CTRL1
506 * HW-controlled: Required range (roof-floor) is programmed into VCORE_CTRL3
509 * Call correct 'set' function accordingly
512 static const struct menelaus_vtg_value vcore_values[] = {
534 int menelaus_set_vcore_sw(unsigned int mV)
537 struct i2c_client *c = the_menelaus->client;
539 val = menelaus_get_vtg_value(mV, vcore_values,
540 ARRAY_SIZE(vcore_values));
544 dev_dbg(&c->dev, "Setting VCORE to %d mV (val 0x%02x)\n", mV, val);
546 /* Set SW mode and the voltage in one go. */
547 mutex_lock(&the_menelaus->lock);
548 ret = menelaus_write_reg(MENELAUS_VCORE_CTRL1, val);
550 the_menelaus->vcore_hw_mode = 0;
551 mutex_unlock(&the_menelaus->lock);
557 int menelaus_set_vcore_hw(unsigned int roof_mV, unsigned int floor_mV)
559 int fval, rval, val, ret;
560 struct i2c_client *c = the_menelaus->client;
562 rval = menelaus_get_vtg_value(roof_mV, vcore_values,
563 ARRAY_SIZE(vcore_values));
566 fval = menelaus_get_vtg_value(floor_mV, vcore_values,
567 ARRAY_SIZE(vcore_values));
571 dev_dbg(&c->dev, "Setting VCORE FLOOR to %d mV and ROOF to %d mV\n",
574 mutex_lock(&the_menelaus->lock);
575 ret = menelaus_write_reg(MENELAUS_VCORE_CTRL3, fval);
578 ret = menelaus_write_reg(MENELAUS_VCORE_CTRL4, rval);
581 if (!the_menelaus->vcore_hw_mode) {
582 val = menelaus_read_reg(MENELAUS_VCORE_CTRL1);
583 /* HW mode, turn OFF byte comparator */
584 val |= ((1 << 7) | (1 << 5));
585 ret = menelaus_write_reg(MENELAUS_VCORE_CTRL1, val);
586 the_menelaus->vcore_hw_mode = 1;
590 mutex_unlock(&the_menelaus->lock);
594 static const struct menelaus_vtg vmem_vtg = {
596 .vtg_reg = MENELAUS_LDO_CTRL1,
599 .mode_reg = MENELAUS_LDO_CTRL3,
602 static const struct menelaus_vtg_value vmem_values[] = {
609 int menelaus_set_vmem(unsigned int mV)
614 return menelaus_set_voltage(&vmem_vtg, 0, 0, 0);
616 val = menelaus_get_vtg_value(mV, vmem_values, ARRAY_SIZE(vmem_values));
619 return menelaus_set_voltage(&vmem_vtg, mV, val, 0x02);
621 EXPORT_SYMBOL(menelaus_set_vmem);
623 static const struct menelaus_vtg vio_vtg = {
625 .vtg_reg = MENELAUS_LDO_CTRL1,
628 .mode_reg = MENELAUS_LDO_CTRL4,
631 static const struct menelaus_vtg_value vio_values[] = {
638 int menelaus_set_vio(unsigned int mV)
643 return menelaus_set_voltage(&vio_vtg, 0, 0, 0);
645 val = menelaus_get_vtg_value(mV, vio_values, ARRAY_SIZE(vio_values));
648 return menelaus_set_voltage(&vio_vtg, mV, val, 0x02);
650 EXPORT_SYMBOL(menelaus_set_vio);
652 static const struct menelaus_vtg_value vdcdc_values[] = {
663 static const struct menelaus_vtg vdcdc2_vtg = {
665 .vtg_reg = MENELAUS_DCDC_CTRL1,
668 .mode_reg = MENELAUS_DCDC_CTRL2,
671 static const struct menelaus_vtg vdcdc3_vtg = {
673 .vtg_reg = MENELAUS_DCDC_CTRL1,
676 .mode_reg = MENELAUS_DCDC_CTRL3,
679 int menelaus_set_vdcdc(int dcdc, unsigned int mV)
681 const struct menelaus_vtg *vtg;
684 if (dcdc != 2 && dcdc != 3)
692 return menelaus_set_voltage(vtg, 0, 0, 0);
694 val = menelaus_get_vtg_value(mV, vdcdc_values,
695 ARRAY_SIZE(vdcdc_values));
698 return menelaus_set_voltage(vtg, mV, val, 0x03);
701 static const struct menelaus_vtg_value vmmc_values[] = {
708 static const struct menelaus_vtg vmmc_vtg = {
710 .vtg_reg = MENELAUS_LDO_CTRL1,
713 .mode_reg = MENELAUS_LDO_CTRL7,
716 int menelaus_set_vmmc(unsigned int mV)
721 return menelaus_set_voltage(&vmmc_vtg, 0, 0, 0);
723 val = menelaus_get_vtg_value(mV, vmmc_values, ARRAY_SIZE(vmmc_values));
726 return menelaus_set_voltage(&vmmc_vtg, mV, val, 0x02);
728 EXPORT_SYMBOL(menelaus_set_vmmc);
731 static const struct menelaus_vtg_value vaux_values[] = {
738 static const struct menelaus_vtg vaux_vtg = {
740 .vtg_reg = MENELAUS_LDO_CTRL1,
743 .mode_reg = MENELAUS_LDO_CTRL6,
746 int menelaus_set_vaux(unsigned int mV)
751 return menelaus_set_voltage(&vaux_vtg, 0, 0, 0);
753 val = menelaus_get_vtg_value(mV, vaux_values, ARRAY_SIZE(vaux_values));
756 return menelaus_set_voltage(&vaux_vtg, mV, val, 0x02);
758 EXPORT_SYMBOL(menelaus_set_vaux);
760 int menelaus_get_slot_pin_states(void)
762 return menelaus_read_reg(MENELAUS_MCT_PIN_ST);
764 EXPORT_SYMBOL(menelaus_get_slot_pin_states);
766 int menelaus_set_regulator_sleep(int enable, u32 val)
769 struct i2c_client *c = the_menelaus->client;
771 mutex_lock(&the_menelaus->lock);
772 ret = menelaus_write_reg(MENELAUS_SLEEP_CTRL2, val);
776 dev_dbg(&c->dev, "regulator sleep configuration: %02x\n", val);
778 ret = menelaus_read_reg(MENELAUS_GPIO_CTRL);
781 t = ((1 << 6) | 0x04);
786 ret = menelaus_write_reg(MENELAUS_GPIO_CTRL, ret);
788 mutex_unlock(&the_menelaus->lock);
792 /*-----------------------------------------------------------------------*/
794 /* Handles Menelaus interrupts. Does not run in interrupt context */
795 static void menelaus_work(struct work_struct *_menelaus)
797 struct menelaus_chip *menelaus =
798 container_of(_menelaus, struct menelaus_chip, work);
799 void (*handler)(struct menelaus_chip *menelaus);
804 isr = (menelaus_read_reg(MENELAUS_INT_STATUS2)
805 & ~menelaus->mask2) << 8;
806 isr |= menelaus_read_reg(MENELAUS_INT_STATUS1)
812 int irq = fls(isr) - 1;
815 mutex_lock(&menelaus->lock);
816 menelaus_disable_irq(irq);
817 menelaus_ack_irq(irq);
818 handler = menelaus->handlers[irq];
821 menelaus_enable_irq(irq);
822 mutex_unlock(&menelaus->lock);
825 enable_irq(menelaus->client->irq);
829 * We cannot use I2C in interrupt context, so we just schedule work.
831 static irqreturn_t menelaus_irq(int irq, void *_menelaus)
833 struct menelaus_chip *menelaus = _menelaus;
835 disable_irq_nosync(irq);
836 (void)schedule_work(&menelaus->work);
841 /*-----------------------------------------------------------------------*/
844 * The RTC needs to be set once, then it runs on backup battery power.
845 * It supports alarms, including system wake alarms (from some modes);
846 * and 1/second IRQs if requested.
848 #ifdef CONFIG_RTC_DRV_TWL92330
850 #define RTC_CTRL_RTC_EN (1 << 0)
851 #define RTC_CTRL_AL_EN (1 << 1)
852 #define RTC_CTRL_MODE12 (1 << 2)
853 #define RTC_CTRL_EVERY_MASK (3 << 3)
854 #define RTC_CTRL_EVERY_SEC (0 << 3)
855 #define RTC_CTRL_EVERY_MIN (1 << 3)
856 #define RTC_CTRL_EVERY_HR (2 << 3)
857 #define RTC_CTRL_EVERY_DAY (3 << 3)
859 #define RTC_UPDATE_EVERY 0x08
861 #define RTC_HR_PM (1 << 7)
863 static void menelaus_to_time(char *regs, struct rtc_time *t)
865 t->tm_sec = BCD2BIN(regs[0]);
866 t->tm_min = BCD2BIN(regs[1]);
867 if (the_menelaus->rtc_control & RTC_CTRL_MODE12) {
868 t->tm_hour = BCD2BIN(regs[2] & 0x1f) - 1;
869 if (regs[2] & RTC_HR_PM)
872 t->tm_hour = BCD2BIN(regs[2] & 0x3f);
873 t->tm_mday = BCD2BIN(regs[3]);
874 t->tm_mon = BCD2BIN(regs[4]) - 1;
875 t->tm_year = BCD2BIN(regs[5]) + 100;
878 static int time_to_menelaus(struct rtc_time *t, int regnum)
882 status = menelaus_write_reg(regnum++, BIN2BCD(t->tm_sec));
886 status = menelaus_write_reg(regnum++, BIN2BCD(t->tm_min));
890 if (the_menelaus->rtc_control & RTC_CTRL_MODE12) {
891 hour = t->tm_hour + 1;
893 hour = RTC_HR_PM | BIN2BCD(hour - 12);
895 hour = BIN2BCD(hour);
897 hour = BIN2BCD(t->tm_hour);
898 status = menelaus_write_reg(regnum++, hour);
902 status = menelaus_write_reg(regnum++, BIN2BCD(t->tm_mday));
906 status = menelaus_write_reg(regnum++, BIN2BCD(t->tm_mon + 1));
910 status = menelaus_write_reg(regnum++, BIN2BCD(t->tm_year - 100));
916 dev_err(&the_menelaus->client->dev, "rtc write reg %02x, err %d\n",
921 static int menelaus_read_time(struct device *dev, struct rtc_time *t)
923 struct i2c_msg msg[2];
927 /* block read date and time registers */
928 regs[0] = MENELAUS_RTC_SEC;
930 msg[0].addr = MENELAUS_I2C_ADDRESS;
935 msg[1].addr = MENELAUS_I2C_ADDRESS;
936 msg[1].flags = I2C_M_RD;
937 msg[1].len = sizeof(regs);
940 status = i2c_transfer(the_menelaus->client->adapter, msg, 2);
942 dev_err(dev, "%s error %d\n", "read", status);
946 menelaus_to_time(regs, t);
947 t->tm_wday = BCD2BIN(regs[6]);
952 static int menelaus_set_time(struct device *dev, struct rtc_time *t)
956 /* write date and time registers */
957 status = time_to_menelaus(t, MENELAUS_RTC_SEC);
960 status = menelaus_write_reg(MENELAUS_RTC_WKDAY, BIN2BCD(t->tm_wday));
962 dev_err(&the_menelaus->client->dev, "rtc write reg %02x"
963 "err %d\n", MENELAUS_RTC_WKDAY, status);
967 /* now commit the write */
968 status = menelaus_write_reg(MENELAUS_RTC_UPDATE, RTC_UPDATE_EVERY);
970 dev_err(&the_menelaus->client->dev, "rtc commit time, err %d\n",
976 static int menelaus_read_alarm(struct device *dev, struct rtc_wkalrm *w)
978 struct i2c_msg msg[2];
982 /* block read alarm registers */
983 regs[0] = MENELAUS_RTC_AL_SEC;
985 msg[0].addr = MENELAUS_I2C_ADDRESS;
990 msg[1].addr = MENELAUS_I2C_ADDRESS;
991 msg[1].flags = I2C_M_RD;
992 msg[1].len = sizeof(regs);
995 status = i2c_transfer(the_menelaus->client->adapter, msg, 2);
997 dev_err(dev, "%s error %d\n", "alarm read", status);
1001 menelaus_to_time(regs, &w->time);
1003 w->enabled = !!(the_menelaus->rtc_control & RTC_CTRL_AL_EN);
1005 /* NOTE we *could* check if actually pending... */
1011 static int menelaus_set_alarm(struct device *dev, struct rtc_wkalrm *w)
1015 if (the_menelaus->client->irq <= 0 && w->enabled)
1018 /* clear previous alarm enable */
1019 if (the_menelaus->rtc_control & RTC_CTRL_AL_EN) {
1020 the_menelaus->rtc_control &= ~RTC_CTRL_AL_EN;
1021 status = menelaus_write_reg(MENELAUS_RTC_CTRL,
1022 the_menelaus->rtc_control);
1027 /* write alarm registers */
1028 status = time_to_menelaus(&w->time, MENELAUS_RTC_AL_SEC);
1032 /* enable alarm if requested */
1034 the_menelaus->rtc_control |= RTC_CTRL_AL_EN;
1035 status = menelaus_write_reg(MENELAUS_RTC_CTRL,
1036 the_menelaus->rtc_control);
1042 #ifdef CONFIG_RTC_INTF_DEV
1044 static void menelaus_rtc_update_work(struct menelaus_chip *m)
1046 /* report 1/sec update */
1047 local_irq_disable();
1048 rtc_update_irq(m->rtc, 1, RTC_IRQF | RTC_UF);
1052 static int menelaus_ioctl(struct device *dev, unsigned cmd, unsigned long arg)
1056 if (the_menelaus->client->irq <= 0)
1057 return -ENOIOCTLCMD;
1062 if (the_menelaus->rtc_control & RTC_CTRL_AL_EN)
1064 the_menelaus->rtc_control |= RTC_CTRL_AL_EN;
1067 if (!(the_menelaus->rtc_control & RTC_CTRL_AL_EN))
1069 the_menelaus->rtc_control &= ~RTC_CTRL_AL_EN;
1071 /* 1/second "update" IRQ */
1073 if (the_menelaus->uie)
1075 status = menelaus_remove_irq_work(MENELAUS_RTCTMR_IRQ);
1076 status = menelaus_add_irq_work(MENELAUS_RTCTMR_IRQ,
1077 menelaus_rtc_update_work);
1079 the_menelaus->uie = 1;
1082 if (!the_menelaus->uie)
1084 status = menelaus_remove_irq_work(MENELAUS_RTCTMR_IRQ);
1086 the_menelaus->uie = 0;
1089 return -ENOIOCTLCMD;
1091 return menelaus_write_reg(MENELAUS_RTC_CTRL, the_menelaus->rtc_control);
1095 #define menelaus_ioctl NULL
1098 /* REVISIT no compensation register support ... */
1100 static const struct rtc_class_ops menelaus_rtc_ops = {
1101 .ioctl = menelaus_ioctl,
1102 .read_time = menelaus_read_time,
1103 .set_time = menelaus_set_time,
1104 .read_alarm = menelaus_read_alarm,
1105 .set_alarm = menelaus_set_alarm,
1108 static void menelaus_rtc_alarm_work(struct menelaus_chip *m)
1111 local_irq_disable();
1112 rtc_update_irq(m->rtc, 1, RTC_IRQF | RTC_AF);
1115 /* then disable it; alarms are oneshot */
1116 the_menelaus->rtc_control &= ~RTC_CTRL_AL_EN;
1117 menelaus_write_reg(MENELAUS_RTC_CTRL, the_menelaus->rtc_control);
1120 static inline void menelaus_rtc_init(struct menelaus_chip *m)
1122 int alarm = (m->client->irq > 0);
1124 /* assume 32KDETEN pin is pulled high */
1125 if (!(menelaus_read_reg(MENELAUS_OSC_CTRL) & 0x80)) {
1126 dev_dbg(&m->client->dev, "no 32k oscillator\n");
1130 /* support RTC alarm; it can issue wakeups */
1132 if (menelaus_add_irq_work(MENELAUS_RTCALM_IRQ,
1133 menelaus_rtc_alarm_work) < 0) {
1134 dev_err(&m->client->dev, "can't handle RTC alarm\n");
1137 device_init_wakeup(&m->client->dev, 1);
1140 /* be sure RTC is enabled; allow 1/sec irqs; leave 12hr mode alone */
1141 m->rtc_control = menelaus_read_reg(MENELAUS_RTC_CTRL);
1142 if (!(m->rtc_control & RTC_CTRL_RTC_EN)
1143 || (m->rtc_control & RTC_CTRL_AL_EN)
1144 || (m->rtc_control & RTC_CTRL_EVERY_MASK)) {
1145 if (!(m->rtc_control & RTC_CTRL_RTC_EN)) {
1146 dev_warn(&m->client->dev, "rtc clock needs setting\n");
1147 m->rtc_control |= RTC_CTRL_RTC_EN;
1149 m->rtc_control &= ~RTC_CTRL_EVERY_MASK;
1150 m->rtc_control &= ~RTC_CTRL_AL_EN;
1151 menelaus_write_reg(MENELAUS_RTC_CTRL, m->rtc_control);
1154 m->rtc = rtc_device_register(DRIVER_NAME,
1156 &menelaus_rtc_ops, THIS_MODULE);
1157 if (IS_ERR(m->rtc)) {
1159 menelaus_remove_irq_work(MENELAUS_RTCALM_IRQ);
1160 device_init_wakeup(&m->client->dev, 0);
1162 dev_err(&m->client->dev, "can't register RTC: %d\n",
1163 (int) PTR_ERR(m->rtc));
1164 the_menelaus->rtc = NULL;
1170 static inline void menelaus_rtc_init(struct menelaus_chip *m)
1177 /*-----------------------------------------------------------------------*/
1179 static struct i2c_driver menelaus_i2c_driver;
1181 static int menelaus_probe(struct i2c_client *client)
1183 struct menelaus_chip *menelaus;
1186 struct menelaus_platform_data *menelaus_pdata =
1187 client->dev.platform_data;
1190 dev_dbg(&client->dev, "only one %s for now\n",
1195 menelaus = kzalloc(sizeof *menelaus, GFP_KERNEL);
1199 i2c_set_clientdata(client, menelaus);
1201 the_menelaus = menelaus;
1202 menelaus->client = client;
1204 /* If a true probe check the device */
1205 rev = menelaus_read_reg(MENELAUS_REV);
1207 dev_err(&client->dev, "device not found");
1212 /* Ack and disable all Menelaus interrupts */
1213 menelaus_write_reg(MENELAUS_INT_ACK1, 0xff);
1214 menelaus_write_reg(MENELAUS_INT_ACK2, 0xff);
1215 menelaus_write_reg(MENELAUS_INT_MASK1, 0xff);
1216 menelaus_write_reg(MENELAUS_INT_MASK2, 0xff);
1217 menelaus->mask1 = 0xff;
1218 menelaus->mask2 = 0xff;
1220 /* Set output buffer strengths */
1221 menelaus_write_reg(MENELAUS_MCT_CTRL1, 0x73);
1223 if (client->irq > 0) {
1224 err = request_irq(client->irq, menelaus_irq, IRQF_DISABLED,
1225 DRIVER_NAME, menelaus);
1227 dev_dbg(&client->dev, "can't get IRQ %d, err %d",
1233 mutex_init(&menelaus->lock);
1234 INIT_WORK(&menelaus->work, menelaus_work);
1236 dev_info(&client->dev, "Menelaus rev %d.%d\n", rev >> 4, rev & 0x0f);
1238 val = menelaus_read_reg(MENELAUS_VCORE_CTRL1);
1242 menelaus->vcore_hw_mode = 1;
1244 menelaus->vcore_hw_mode = 0;
1246 if (menelaus_pdata != NULL && menelaus_pdata->late_init != NULL) {
1247 err = menelaus_pdata->late_init(&client->dev);
1252 menelaus_rtc_init(menelaus);
1256 free_irq(client->irq, menelaus);
1257 flush_scheduled_work();
1263 static int __exit menelaus_remove(struct i2c_client *client)
1265 struct menelaus_chip *menelaus = i2c_get_clientdata(client);
1267 free_irq(client->irq, menelaus);
1269 i2c_set_clientdata(client, NULL);
1270 the_menelaus = NULL;
1274 static struct i2c_driver menelaus_i2c_driver = {
1276 .name = DRIVER_NAME,
1278 .probe = menelaus_probe,
1279 .remove = __exit_p(menelaus_remove),
1282 static int __init menelaus_init(void)
1284 return i2c_add_driver(&menelaus_i2c_driver);
1287 static void __exit menelaus_exit(void)
1289 i2c_del_driver(&menelaus_i2c_driver);
1291 /* FIXME: Shutdown menelaus parts that can be shut down */
1294 MODULE_AUTHOR("Texas Instruments, Inc. (and others)");
1295 MODULE_DESCRIPTION("I2C interface for Menelaus.");
1296 MODULE_LICENSE("GPL");
1298 module_init(menelaus_init);
1299 module_exit(menelaus_exit);