drivers/mfd/menelaus.c

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