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_set_mmc_slot(int slot, int enable, int power, int cd_en)
321 if (slot != 1 && slot != 2)
326 mutex_lock(&the_menelaus->lock);
328 ret = menelaus_read_reg(MENELAUS_MCT_CTRL2);
334 val |= (1 << 4) | (1 << 6);
336 val &= ~((1 << 4) | (1 << 6));
339 val |= (1 << 5) | (1 << 7);
341 val &= ~((1 << 5) | (1 << 7));
343 ret = menelaus_write_reg(MENELAUS_MCT_CTRL2, val);
347 ret = menelaus_read_reg(MENELAUS_MCT_CTRL3);
363 b = menelaus_read_reg(MENELAUS_MCT_CTRL2);
366 ret = menelaus_write_reg(MENELAUS_MCT_CTRL2, b);
370 /* Disable autonomous shutdown */
372 ret = menelaus_write_reg(MENELAUS_MCT_CTRL3, val);
374 mutex_unlock(&the_menelaus->lock);
377 EXPORT_SYMBOL(menelaus_set_mmc_slot);
379 int menelaus_register_mmc_callback(void (*callback)(void *data, u8 card_mask),
384 the_menelaus->mmc_callback_data = data;
385 the_menelaus->mmc_callback = callback;
386 ret = menelaus_add_irq_work(MENELAUS_MMC_S1CD_IRQ,
387 menelaus_mmc_cd_work);
390 ret = menelaus_add_irq_work(MENELAUS_MMC_S2CD_IRQ,
391 menelaus_mmc_cd_work);
394 ret = menelaus_add_irq_work(MENELAUS_MMC_S1D1_IRQ,
395 menelaus_mmc_cd_work);
398 ret = menelaus_add_irq_work(MENELAUS_MMC_S2D1_IRQ,
399 menelaus_mmc_cd_work);
403 EXPORT_SYMBOL(menelaus_register_mmc_callback);
405 void menelaus_unregister_mmc_callback(void)
407 menelaus_remove_irq_work(MENELAUS_MMC_S1CD_IRQ);
408 menelaus_remove_irq_work(MENELAUS_MMC_S2CD_IRQ);
409 menelaus_remove_irq_work(MENELAUS_MMC_S1D1_IRQ);
410 menelaus_remove_irq_work(MENELAUS_MMC_S2D1_IRQ);
412 the_menelaus->mmc_callback = NULL;
413 the_menelaus->mmc_callback_data = 0;
415 EXPORT_SYMBOL(menelaus_unregister_mmc_callback);
417 struct menelaus_vtg {
425 struct menelaus_vtg_value {
430 static int menelaus_set_voltage(const struct menelaus_vtg *vtg, int mV,
431 int vtg_val, int mode)
434 struct i2c_client *c = the_menelaus->client;
436 mutex_lock(&the_menelaus->lock);
440 ret = menelaus_read_reg(vtg->vtg_reg);
443 val = ret & ~(((1 << vtg->vtg_bits) - 1) << vtg->vtg_shift);
444 val |= vtg_val << vtg->vtg_shift;
446 dev_dbg(&c->dev, "Setting voltage '%s'"
447 "to %d mV (reg 0x%02x, val 0x%02x)\n",
448 vtg->name, mV, vtg->vtg_reg, val);
450 ret = menelaus_write_reg(vtg->vtg_reg, val);
454 ret = menelaus_write_reg(vtg->mode_reg, mode);
456 mutex_unlock(&the_menelaus->lock);
458 /* Wait for voltage to stabilize */
464 static int menelaus_get_vtg_value(int vtg, const struct menelaus_vtg_value *tbl,
469 for (i = 0; i < n; i++, tbl++)
476 * Vcore can be programmed in two ways:
477 * SW-controlled: Required voltage is programmed into VCORE_CTRL1
478 * HW-controlled: Required range (roof-floor) is programmed into VCORE_CTRL3
481 * Call correct 'set' function accordingly
484 static const struct menelaus_vtg_value vcore_values[] = {
506 int menelaus_set_vcore_sw(unsigned int mV)
509 struct i2c_client *c = the_menelaus->client;
511 val = menelaus_get_vtg_value(mV, vcore_values,
512 ARRAY_SIZE(vcore_values));
516 dev_dbg(&c->dev, "Setting VCORE to %d mV (val 0x%02x)\n", mV, val);
518 /* Set SW mode and the voltage in one go. */
519 mutex_lock(&the_menelaus->lock);
520 ret = menelaus_write_reg(MENELAUS_VCORE_CTRL1, val);
522 the_menelaus->vcore_hw_mode = 0;
523 mutex_unlock(&the_menelaus->lock);
529 int menelaus_set_vcore_hw(unsigned int roof_mV, unsigned int floor_mV)
531 int fval, rval, val, ret;
532 struct i2c_client *c = the_menelaus->client;
534 rval = menelaus_get_vtg_value(roof_mV, vcore_values,
535 ARRAY_SIZE(vcore_values));
538 fval = menelaus_get_vtg_value(floor_mV, vcore_values,
539 ARRAY_SIZE(vcore_values));
543 dev_dbg(&c->dev, "Setting VCORE FLOOR to %d mV and ROOF to %d mV\n",
546 mutex_lock(&the_menelaus->lock);
547 ret = menelaus_write_reg(MENELAUS_VCORE_CTRL3, fval);
550 ret = menelaus_write_reg(MENELAUS_VCORE_CTRL4, rval);
553 if (!the_menelaus->vcore_hw_mode) {
554 val = menelaus_read_reg(MENELAUS_VCORE_CTRL1);
555 /* HW mode, turn OFF byte comparator */
556 val |= ((1 << 7) | (1 << 5));
557 ret = menelaus_write_reg(MENELAUS_VCORE_CTRL1, val);
558 the_menelaus->vcore_hw_mode = 1;
562 mutex_unlock(&the_menelaus->lock);
566 static const struct menelaus_vtg vmem_vtg = {
568 .vtg_reg = MENELAUS_LDO_CTRL1,
571 .mode_reg = MENELAUS_LDO_CTRL3,
574 static const struct menelaus_vtg_value vmem_values[] = {
581 int menelaus_set_vmem(unsigned int mV)
586 return menelaus_set_voltage(&vmem_vtg, 0, 0, 0);
588 val = menelaus_get_vtg_value(mV, vmem_values, ARRAY_SIZE(vmem_values));
591 return menelaus_set_voltage(&vmem_vtg, mV, val, 0x02);
593 EXPORT_SYMBOL(menelaus_set_vmem);
595 static const struct menelaus_vtg vio_vtg = {
597 .vtg_reg = MENELAUS_LDO_CTRL1,
600 .mode_reg = MENELAUS_LDO_CTRL4,
603 static const struct menelaus_vtg_value vio_values[] = {
610 int menelaus_set_vio(unsigned int mV)
615 return menelaus_set_voltage(&vio_vtg, 0, 0, 0);
617 val = menelaus_get_vtg_value(mV, vio_values, ARRAY_SIZE(vio_values));
620 return menelaus_set_voltage(&vio_vtg, mV, val, 0x02);
622 EXPORT_SYMBOL(menelaus_set_vio);
624 static const struct menelaus_vtg_value vdcdc_values[] = {
635 static const struct menelaus_vtg vdcdc2_vtg = {
637 .vtg_reg = MENELAUS_DCDC_CTRL1,
640 .mode_reg = MENELAUS_DCDC_CTRL2,
643 static const struct menelaus_vtg vdcdc3_vtg = {
645 .vtg_reg = MENELAUS_DCDC_CTRL1,
648 .mode_reg = MENELAUS_DCDC_CTRL3,
651 int menelaus_set_vdcdc(int dcdc, unsigned int mV)
653 const struct menelaus_vtg *vtg;
656 if (dcdc != 2 && dcdc != 3)
664 return menelaus_set_voltage(vtg, 0, 0, 0);
666 val = menelaus_get_vtg_value(mV, vdcdc_values,
667 ARRAY_SIZE(vdcdc_values));
670 return menelaus_set_voltage(vtg, mV, val, 0x03);
673 static const struct menelaus_vtg_value vmmc_values[] = {
680 static const struct menelaus_vtg vmmc_vtg = {
682 .vtg_reg = MENELAUS_LDO_CTRL1,
685 .mode_reg = MENELAUS_LDO_CTRL7,
688 int menelaus_set_vmmc(unsigned int mV)
693 return menelaus_set_voltage(&vmmc_vtg, 0, 0, 0);
695 val = menelaus_get_vtg_value(mV, vmmc_values, ARRAY_SIZE(vmmc_values));
698 return menelaus_set_voltage(&vmmc_vtg, mV, val, 0x02);
700 EXPORT_SYMBOL(menelaus_set_vmmc);
703 static const struct menelaus_vtg_value vaux_values[] = {
710 static const struct menelaus_vtg vaux_vtg = {
712 .vtg_reg = MENELAUS_LDO_CTRL1,
715 .mode_reg = MENELAUS_LDO_CTRL6,
718 int menelaus_set_vaux(unsigned int mV)
723 return menelaus_set_voltage(&vaux_vtg, 0, 0, 0);
725 val = menelaus_get_vtg_value(mV, vaux_values, ARRAY_SIZE(vaux_values));
728 return menelaus_set_voltage(&vaux_vtg, mV, val, 0x02);
730 EXPORT_SYMBOL(menelaus_set_vaux);
732 int menelaus_get_slot_pin_states(void)
734 return menelaus_read_reg(MENELAUS_MCT_PIN_ST);
736 EXPORT_SYMBOL(menelaus_get_slot_pin_states);
738 int menelaus_set_regulator_sleep(int enable, u32 val)
741 struct i2c_client *c = the_menelaus->client;
743 mutex_lock(&the_menelaus->lock);
744 ret = menelaus_write_reg(MENELAUS_SLEEP_CTRL2, val);
748 dev_dbg(&c->dev, "regulator sleep configuration: %02x\n", val);
750 ret = menelaus_read_reg(MENELAUS_GPIO_CTRL);
753 t = ((1 << 6) | 0x04);
758 ret = menelaus_write_reg(MENELAUS_GPIO_CTRL, ret);
760 mutex_unlock(&the_menelaus->lock);
764 /*-----------------------------------------------------------------------*/
766 /* Handles Menelaus interrupts. Does not run in interrupt context */
767 static void menelaus_work(struct work_struct *_menelaus)
769 struct menelaus_chip *menelaus =
770 container_of(_menelaus, struct menelaus_chip, work);
771 void (*handler)(struct menelaus_chip *menelaus);
776 isr = (menelaus_read_reg(MENELAUS_INT_STATUS2)
777 & ~menelaus->mask2) << 8;
778 isr |= menelaus_read_reg(MENELAUS_INT_STATUS1)
784 int irq = fls(isr) - 1;
787 mutex_lock(&menelaus->lock);
788 menelaus_disable_irq(irq);
789 menelaus_ack_irq(irq);
790 handler = menelaus->handlers[irq];
793 menelaus_enable_irq(irq);
794 mutex_unlock(&menelaus->lock);
797 enable_irq(menelaus->client->irq);
801 * We cannot use I2C in interrupt context, so we just schedule work.
803 static irqreturn_t menelaus_irq(int irq, void *_menelaus)
805 struct menelaus_chip *menelaus = _menelaus;
807 disable_irq_nosync(irq);
808 (void)schedule_work(&menelaus->work);
813 /*-----------------------------------------------------------------------*/
816 * The RTC needs to be set once, then it runs on backup battery power.
817 * It supports alarms, including system wake alarms (from some modes);
818 * and 1/second IRQs if requested.
820 #ifdef CONFIG_RTC_DRV_TWL92330
822 #define RTC_CTRL_RTC_EN (1 << 0)
823 #define RTC_CTRL_AL_EN (1 << 1)
824 #define RTC_CTRL_MODE12 (1 << 2)
825 #define RTC_CTRL_EVERY_MASK (3 << 3)
826 #define RTC_CTRL_EVERY_SEC (0 << 3)
827 #define RTC_CTRL_EVERY_MIN (1 << 3)
828 #define RTC_CTRL_EVERY_HR (2 << 3)
829 #define RTC_CTRL_EVERY_DAY (3 << 3)
831 #define RTC_UPDATE_EVERY 0x08
833 #define RTC_HR_PM (1 << 7)
835 static void menelaus_to_time(char *regs, struct rtc_time *t)
837 t->tm_sec = BCD2BIN(regs[0]);
838 t->tm_min = BCD2BIN(regs[1]);
839 if (the_menelaus->rtc_control & RTC_CTRL_MODE12) {
840 t->tm_hour = BCD2BIN(regs[2] & 0x1f) - 1;
841 if (regs[2] & RTC_HR_PM)
844 t->tm_hour = BCD2BIN(regs[2] & 0x3f);
845 t->tm_mday = BCD2BIN(regs[3]);
846 t->tm_mon = BCD2BIN(regs[4]) - 1;
847 t->tm_year = BCD2BIN(regs[5]) + 100;
850 static int time_to_menelaus(struct rtc_time *t, int regnum)
854 status = menelaus_write_reg(regnum++, BIN2BCD(t->tm_sec));
858 status = menelaus_write_reg(regnum++, BIN2BCD(t->tm_min));
862 if (the_menelaus->rtc_control & RTC_CTRL_MODE12) {
863 hour = t->tm_hour + 1;
865 hour = RTC_HR_PM | BIN2BCD(hour - 12);
867 hour = BIN2BCD(hour);
869 hour = BIN2BCD(t->tm_hour);
870 status = menelaus_write_reg(regnum++, hour);
874 status = menelaus_write_reg(regnum++, BIN2BCD(t->tm_mday));
878 status = menelaus_write_reg(regnum++, BIN2BCD(t->tm_mon + 1));
882 status = menelaus_write_reg(regnum++, BIN2BCD(t->tm_year - 100));
888 dev_err(&the_menelaus->client->dev, "rtc write reg %02x, err %d\n",
893 static int menelaus_read_time(struct device *dev, struct rtc_time *t)
895 struct i2c_msg msg[2];
899 /* block read date and time registers */
900 regs[0] = MENELAUS_RTC_SEC;
902 msg[0].addr = MENELAUS_I2C_ADDRESS;
907 msg[1].addr = MENELAUS_I2C_ADDRESS;
908 msg[1].flags = I2C_M_RD;
909 msg[1].len = sizeof(regs);
912 status = i2c_transfer(the_menelaus->client->adapter, msg, 2);
914 dev_err(dev, "%s error %d\n", "read", status);
918 menelaus_to_time(regs, t);
919 t->tm_wday = BCD2BIN(regs[6]);
924 static int menelaus_set_time(struct device *dev, struct rtc_time *t)
928 /* write date and time registers */
929 status = time_to_menelaus(t, MENELAUS_RTC_SEC);
932 status = menelaus_write_reg(MENELAUS_RTC_WKDAY, BIN2BCD(t->tm_wday));
934 dev_err(&the_menelaus->client->dev, "rtc write reg %02x"
935 "err %d\n", MENELAUS_RTC_WKDAY, status);
939 /* now commit the write */
940 status = menelaus_write_reg(MENELAUS_RTC_UPDATE, RTC_UPDATE_EVERY);
942 dev_err(&the_menelaus->client->dev, "rtc commit time, err %d\n",
948 static int menelaus_read_alarm(struct device *dev, struct rtc_wkalrm *w)
950 struct i2c_msg msg[2];
954 /* block read alarm registers */
955 regs[0] = MENELAUS_RTC_AL_SEC;
957 msg[0].addr = MENELAUS_I2C_ADDRESS;
962 msg[1].addr = MENELAUS_I2C_ADDRESS;
963 msg[1].flags = I2C_M_RD;
964 msg[1].len = sizeof(regs);
967 status = i2c_transfer(the_menelaus->client->adapter, msg, 2);
969 dev_err(dev, "%s error %d\n", "alarm read", status);
973 menelaus_to_time(regs, &w->time);
975 w->enabled = !!(the_menelaus->rtc_control & RTC_CTRL_AL_EN);
977 /* NOTE we *could* check if actually pending... */
983 static int menelaus_set_alarm(struct device *dev, struct rtc_wkalrm *w)
987 if (the_menelaus->client->irq <= 0 && w->enabled)
990 /* clear previous alarm enable */
991 if (the_menelaus->rtc_control & RTC_CTRL_AL_EN) {
992 the_menelaus->rtc_control &= ~RTC_CTRL_AL_EN;
993 status = menelaus_write_reg(MENELAUS_RTC_CTRL,
994 the_menelaus->rtc_control);
999 /* write alarm registers */
1000 status = time_to_menelaus(&w->time, MENELAUS_RTC_AL_SEC);
1004 /* enable alarm if requested */
1006 the_menelaus->rtc_control |= RTC_CTRL_AL_EN;
1007 status = menelaus_write_reg(MENELAUS_RTC_CTRL,
1008 the_menelaus->rtc_control);
1014 #ifdef CONFIG_RTC_INTF_DEV
1016 static void menelaus_rtc_update_work(struct menelaus_chip *m)
1018 /* report 1/sec update */
1019 local_irq_disable();
1020 rtc_update_irq(m->rtc, 1, RTC_IRQF | RTC_UF);
1024 static int menelaus_ioctl(struct device *dev, unsigned cmd, unsigned long arg)
1028 if (the_menelaus->client->irq <= 0)
1029 return -ENOIOCTLCMD;
1034 if (the_menelaus->rtc_control & RTC_CTRL_AL_EN)
1036 the_menelaus->rtc_control |= RTC_CTRL_AL_EN;
1039 if (!(the_menelaus->rtc_control & RTC_CTRL_AL_EN))
1041 the_menelaus->rtc_control &= ~RTC_CTRL_AL_EN;
1043 /* 1/second "update" IRQ */
1045 if (the_menelaus->uie)
1047 status = menelaus_remove_irq_work(MENELAUS_RTCTMR_IRQ);
1048 status = menelaus_add_irq_work(MENELAUS_RTCTMR_IRQ,
1049 menelaus_rtc_update_work);
1051 the_menelaus->uie = 1;
1054 if (!the_menelaus->uie)
1056 status = menelaus_remove_irq_work(MENELAUS_RTCTMR_IRQ);
1058 the_menelaus->uie = 0;
1061 return -ENOIOCTLCMD;
1063 return menelaus_write_reg(MENELAUS_RTC_CTRL, the_menelaus->rtc_control);
1067 #define menelaus_ioctl NULL
1070 /* REVISIT no compensation register support ... */
1072 static const struct rtc_class_ops menelaus_rtc_ops = {
1073 .ioctl = menelaus_ioctl,
1074 .read_time = menelaus_read_time,
1075 .set_time = menelaus_set_time,
1076 .read_alarm = menelaus_read_alarm,
1077 .set_alarm = menelaus_set_alarm,
1080 static void menelaus_rtc_alarm_work(struct menelaus_chip *m)
1083 local_irq_disable();
1084 rtc_update_irq(m->rtc, 1, RTC_IRQF | RTC_AF);
1087 /* then disable it; alarms are oneshot */
1088 the_menelaus->rtc_control &= ~RTC_CTRL_AL_EN;
1089 menelaus_write_reg(MENELAUS_RTC_CTRL, the_menelaus->rtc_control);
1092 static inline void menelaus_rtc_init(struct menelaus_chip *m)
1094 int alarm = (m->client->irq > 0);
1096 /* assume 32KDETEN pin is pulled high */
1097 if (!(menelaus_read_reg(MENELAUS_OSC_CTRL) & 0x80)) {
1098 dev_dbg(&m->client->dev, "no 32k oscillator\n");
1102 /* support RTC alarm; it can issue wakeups */
1104 if (menelaus_add_irq_work(MENELAUS_RTCALM_IRQ,
1105 menelaus_rtc_alarm_work) < 0) {
1106 dev_err(&m->client->dev, "can't handle RTC alarm\n");
1109 device_init_wakeup(&m->client->dev, 1);
1112 /* be sure RTC is enabled; allow 1/sec irqs; leave 12hr mode alone */
1113 m->rtc_control = menelaus_read_reg(MENELAUS_RTC_CTRL);
1114 if (!(m->rtc_control & RTC_CTRL_RTC_EN)
1115 || (m->rtc_control & RTC_CTRL_AL_EN)
1116 || (m->rtc_control & RTC_CTRL_EVERY_MASK)) {
1117 if (!(m->rtc_control & RTC_CTRL_RTC_EN)) {
1118 dev_warn(&m->client->dev, "rtc clock needs setting\n");
1119 m->rtc_control |= RTC_CTRL_RTC_EN;
1121 m->rtc_control &= ~RTC_CTRL_EVERY_MASK;
1122 m->rtc_control &= ~RTC_CTRL_AL_EN;
1123 menelaus_write_reg(MENELAUS_RTC_CTRL, m->rtc_control);
1126 m->rtc = rtc_device_register(DRIVER_NAME,
1128 &menelaus_rtc_ops, THIS_MODULE);
1129 if (IS_ERR(m->rtc)) {
1131 menelaus_remove_irq_work(MENELAUS_RTCALM_IRQ);
1132 device_init_wakeup(&m->client->dev, 0);
1134 dev_err(&m->client->dev, "can't register RTC: %d\n",
1135 (int) PTR_ERR(m->rtc));
1136 the_menelaus->rtc = NULL;
1142 static inline void menelaus_rtc_init(struct menelaus_chip *m)
1149 /*-----------------------------------------------------------------------*/
1151 static struct i2c_driver menelaus_i2c_driver;
1153 static int menelaus_probe(struct i2c_client *client)
1155 struct menelaus_chip *menelaus;
1158 struct menelaus_platform_data *menelaus_pdata =
1159 client->dev.platform_data;
1162 dev_dbg(&client->dev, "only one %s for now\n",
1167 menelaus = kzalloc(sizeof *menelaus, GFP_KERNEL);
1171 i2c_set_clientdata(client, menelaus);
1173 the_menelaus = menelaus;
1174 menelaus->client = client;
1176 /* If a true probe check the device */
1177 rev = menelaus_read_reg(MENELAUS_REV);
1179 dev_err(&client->dev, "device not found");
1184 /* Ack and disable all Menelaus interrupts */
1185 menelaus_write_reg(MENELAUS_INT_ACK1, 0xff);
1186 menelaus_write_reg(MENELAUS_INT_ACK2, 0xff);
1187 menelaus_write_reg(MENELAUS_INT_MASK1, 0xff);
1188 menelaus_write_reg(MENELAUS_INT_MASK2, 0xff);
1189 menelaus->mask1 = 0xff;
1190 menelaus->mask2 = 0xff;
1192 /* Set output buffer strengths */
1193 menelaus_write_reg(MENELAUS_MCT_CTRL1, 0x73);
1195 if (client->irq > 0) {
1196 err = request_irq(client->irq, menelaus_irq, IRQF_DISABLED,
1197 DRIVER_NAME, menelaus);
1199 dev_dbg(&client->dev, "can't get IRQ %d, err %d",
1205 mutex_init(&menelaus->lock);
1206 INIT_WORK(&menelaus->work, menelaus_work);
1208 dev_info(&client->dev, "Menelaus rev %d.%d\n", rev >> 4, rev & 0x0f);
1210 val = menelaus_read_reg(MENELAUS_VCORE_CTRL1);
1214 menelaus->vcore_hw_mode = 1;
1216 menelaus->vcore_hw_mode = 0;
1218 if (menelaus_pdata != NULL && menelaus_pdata->late_init != NULL) {
1219 err = menelaus_pdata->late_init(&client->dev);
1224 menelaus_rtc_init(menelaus);
1228 free_irq(client->irq, menelaus);
1229 flush_scheduled_work();
1235 static int __exit menelaus_remove(struct i2c_client *client)
1237 struct menelaus_chip *menelaus = i2c_get_clientdata(client);
1239 free_irq(client->irq, menelaus);
1241 i2c_set_clientdata(client, NULL);
1242 the_menelaus = NULL;
1246 static struct i2c_driver menelaus_i2c_driver = {
1248 .name = DRIVER_NAME,
1250 .probe = menelaus_probe,
1251 .remove = __exit_p(menelaus_remove),
1254 static int __init menelaus_init(void)
1258 res = i2c_add_driver(&menelaus_i2c_driver);
1260 dev_err(&the_menelaus->client->dev, "driver registration failed\n");
1267 static void __exit menelaus_exit(void)
1269 i2c_del_driver(&menelaus_i2c_driver);
1271 /* FIXME: Shutdown menelaus parts that can be shut down */
1274 MODULE_AUTHOR("Texas Instruments, Inc. (and others)");
1275 MODULE_DESCRIPTION("I2C interface for Menelaus.");
1276 MODULE_LICENSE("GPL");
1278 module_init(menelaus_init);
1279 module_exit(menelaus_exit);