123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828 |
- /*
- * Copyright (c) 2013-2014 Samsung Electronics Co., Ltd
- * http://www.samsung.com
- *
- * Copyright (C) 2013 Google, Inc
- *
- * This program is free software; you can redistribute it and/or modify
- * it under the terms of the GNU General Public License as published by
- * the Free Software Foundation; either version 2 of the License, or
- * (at your option) any later version.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- */
- #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
- #include <linux/module.h>
- #include <linux/i2c.h>
- #include <linux/bcd.h>
- #include <linux/regmap.h>
- #include <linux/rtc.h>
- #include <linux/platform_device.h>
- #include <linux/mfd/samsung/core.h>
- #include <linux/mfd/samsung/irq.h>
- #include <linux/mfd/samsung/rtc.h>
- #include <linux/mfd/samsung/s2mps14.h>
- /*
- * Maximum number of retries for checking changes in UDR field
- * of S5M_RTC_UDR_CON register (to limit possible endless loop).
- *
- * After writing to RTC registers (setting time or alarm) read the UDR field
- * in S5M_RTC_UDR_CON register. UDR is auto-cleared when data have
- * been transferred.
- */
- #define UDR_READ_RETRY_CNT 5
- /* Registers used by the driver which are different between chipsets. */
- struct s5m_rtc_reg_config {
- /* Number of registers used for setting time/alarm0/alarm1 */
- unsigned int regs_count;
- /* First register for time, seconds */
- unsigned int time;
- /* RTC control register */
- unsigned int ctrl;
- /* First register for alarm 0, seconds */
- unsigned int alarm0;
- /* First register for alarm 1, seconds */
- unsigned int alarm1;
- /*
- * Register for update flag (UDR). Typically setting UDR field to 1
- * will enable update of time or alarm register. Then it will be
- * auto-cleared after successful update.
- */
- unsigned int rtc_udr_update;
- /* Mask for UDR field in 'rtc_udr_update' register */
- unsigned int rtc_udr_mask;
- };
- /* Register map for S5M8763 and S5M8767 */
- static const struct s5m_rtc_reg_config s5m_rtc_regs = {
- .regs_count = 8,
- .time = S5M_RTC_SEC,
- .ctrl = S5M_ALARM1_CONF,
- .alarm0 = S5M_ALARM0_SEC,
- .alarm1 = S5M_ALARM1_SEC,
- .rtc_udr_update = S5M_RTC_UDR_CON,
- .rtc_udr_mask = S5M_RTC_UDR_MASK,
- };
- /*
- * Register map for S2MPS14.
- * It may be also suitable for S2MPS11 but this was not tested.
- */
- static const struct s5m_rtc_reg_config s2mps_rtc_regs = {
- .regs_count = 7,
- .time = S2MPS_RTC_SEC,
- .ctrl = S2MPS_RTC_CTRL,
- .alarm0 = S2MPS_ALARM0_SEC,
- .alarm1 = S2MPS_ALARM1_SEC,
- .rtc_udr_update = S2MPS_RTC_UDR_CON,
- .rtc_udr_mask = S2MPS_RTC_WUDR_MASK,
- };
- struct s5m_rtc_info {
- struct device *dev;
- struct i2c_client *i2c;
- struct sec_pmic_dev *s5m87xx;
- struct regmap *regmap;
- struct rtc_device *rtc_dev;
- int irq;
- enum sec_device_type device_type;
- int rtc_24hr_mode;
- const struct s5m_rtc_reg_config *regs;
- };
- static const struct regmap_config s5m_rtc_regmap_config = {
- .reg_bits = 8,
- .val_bits = 8,
- .max_register = S5M_RTC_REG_MAX,
- };
- static const struct regmap_config s2mps14_rtc_regmap_config = {
- .reg_bits = 8,
- .val_bits = 8,
- .max_register = S2MPS_RTC_REG_MAX,
- };
- static void s5m8767_data_to_tm(u8 *data, struct rtc_time *tm,
- int rtc_24hr_mode)
- {
- tm->tm_sec = data[RTC_SEC] & 0x7f;
- tm->tm_min = data[RTC_MIN] & 0x7f;
- if (rtc_24hr_mode) {
- tm->tm_hour = data[RTC_HOUR] & 0x1f;
- } else {
- tm->tm_hour = data[RTC_HOUR] & 0x0f;
- if (data[RTC_HOUR] & HOUR_PM_MASK)
- tm->tm_hour += 12;
- }
- tm->tm_wday = ffs(data[RTC_WEEKDAY] & 0x7f);
- tm->tm_mday = data[RTC_DATE] & 0x1f;
- tm->tm_mon = (data[RTC_MONTH] & 0x0f) - 1;
- tm->tm_year = (data[RTC_YEAR1] & 0x7f) + 100;
- tm->tm_yday = 0;
- tm->tm_isdst = 0;
- }
- static int s5m8767_tm_to_data(struct rtc_time *tm, u8 *data)
- {
- data[RTC_SEC] = tm->tm_sec;
- data[RTC_MIN] = tm->tm_min;
- if (tm->tm_hour >= 12)
- data[RTC_HOUR] = tm->tm_hour | HOUR_PM_MASK;
- else
- data[RTC_HOUR] = tm->tm_hour & ~HOUR_PM_MASK;
- data[RTC_WEEKDAY] = 1 << tm->tm_wday;
- data[RTC_DATE] = tm->tm_mday;
- data[RTC_MONTH] = tm->tm_mon + 1;
- data[RTC_YEAR1] = tm->tm_year > 100 ? (tm->tm_year - 100) : 0;
- if (tm->tm_year < 100) {
- pr_err("RTC cannot handle the year %d\n",
- 1900 + tm->tm_year);
- return -EINVAL;
- } else {
- return 0;
- }
- }
- /*
- * Read RTC_UDR_CON register and wait till UDR field is cleared.
- * This indicates that time/alarm update ended.
- */
- static inline int s5m8767_wait_for_udr_update(struct s5m_rtc_info *info)
- {
- int ret, retry = UDR_READ_RETRY_CNT;
- unsigned int data;
- do {
- ret = regmap_read(info->regmap, info->regs->rtc_udr_update,
- &data);
- } while (--retry && (data & info->regs->rtc_udr_mask) && !ret);
- if (!retry)
- dev_err(info->dev, "waiting for UDR update, reached max number of retries\n");
- return ret;
- }
- static inline int s5m_check_peding_alarm_interrupt(struct s5m_rtc_info *info,
- struct rtc_wkalrm *alarm)
- {
- int ret;
- unsigned int val;
- switch (info->device_type) {
- case S5M8767X:
- case S5M8763X:
- ret = regmap_read(info->regmap, S5M_RTC_STATUS, &val);
- val &= S5M_ALARM0_STATUS;
- break;
- case S2MPS14X:
- case S2MPS13X:
- ret = regmap_read(info->s5m87xx->regmap_pmic, S2MPS14_REG_ST2,
- &val);
- val &= S2MPS_ALARM0_STATUS;
- break;
- default:
- return -EINVAL;
- }
- if (ret < 0)
- return ret;
- if (val)
- alarm->pending = 1;
- else
- alarm->pending = 0;
- return 0;
- }
- static inline int s5m8767_rtc_set_time_reg(struct s5m_rtc_info *info)
- {
- int ret;
- unsigned int data;
- ret = regmap_read(info->regmap, info->regs->rtc_udr_update, &data);
- if (ret < 0) {
- dev_err(info->dev, "failed to read update reg(%d)\n", ret);
- return ret;
- }
- data |= info->regs->rtc_udr_mask;
- if (info->device_type == S5M8763X || info->device_type == S5M8767X)
- data |= S5M_RTC_TIME_EN_MASK;
- ret = regmap_write(info->regmap, info->regs->rtc_udr_update, data);
- if (ret < 0) {
- dev_err(info->dev, "failed to write update reg(%d)\n", ret);
- return ret;
- }
- ret = s5m8767_wait_for_udr_update(info);
- return ret;
- }
- static inline int s5m8767_rtc_set_alarm_reg(struct s5m_rtc_info *info)
- {
- int ret;
- unsigned int data;
- ret = regmap_read(info->regmap, info->regs->rtc_udr_update, &data);
- if (ret < 0) {
- dev_err(info->dev, "%s: fail to read update reg(%d)\n",
- __func__, ret);
- return ret;
- }
- data |= info->regs->rtc_udr_mask;
- switch (info->device_type) {
- case S5M8763X:
- case S5M8767X:
- data &= ~S5M_RTC_TIME_EN_MASK;
- break;
- case S2MPS14X:
- data |= S2MPS_RTC_RUDR_MASK;
- break;
- case S2MPS13X:
- data |= S2MPS13_RTC_AUDR_MASK;
- break;
- default:
- return -EINVAL;
- }
- ret = regmap_write(info->regmap, info->regs->rtc_udr_update, data);
- if (ret < 0) {
- dev_err(info->dev, "%s: fail to write update reg(%d)\n",
- __func__, ret);
- return ret;
- }
- ret = s5m8767_wait_for_udr_update(info);
- /* On S2MPS13 the AUDR is not auto-cleared */
- if (info->device_type == S2MPS13X)
- regmap_update_bits(info->regmap, info->regs->rtc_udr_update,
- S2MPS13_RTC_AUDR_MASK, 0);
- return ret;
- }
- static void s5m8763_data_to_tm(u8 *data, struct rtc_time *tm)
- {
- tm->tm_sec = bcd2bin(data[RTC_SEC]);
- tm->tm_min = bcd2bin(data[RTC_MIN]);
- if (data[RTC_HOUR] & HOUR_12) {
- tm->tm_hour = bcd2bin(data[RTC_HOUR] & 0x1f);
- if (data[RTC_HOUR] & HOUR_PM)
- tm->tm_hour += 12;
- } else {
- tm->tm_hour = bcd2bin(data[RTC_HOUR] & 0x3f);
- }
- tm->tm_wday = data[RTC_WEEKDAY] & 0x07;
- tm->tm_mday = bcd2bin(data[RTC_DATE]);
- tm->tm_mon = bcd2bin(data[RTC_MONTH]);
- tm->tm_year = bcd2bin(data[RTC_YEAR1]) + bcd2bin(data[RTC_YEAR2]) * 100;
- tm->tm_year -= 1900;
- }
- static void s5m8763_tm_to_data(struct rtc_time *tm, u8 *data)
- {
- data[RTC_SEC] = bin2bcd(tm->tm_sec);
- data[RTC_MIN] = bin2bcd(tm->tm_min);
- data[RTC_HOUR] = bin2bcd(tm->tm_hour);
- data[RTC_WEEKDAY] = tm->tm_wday;
- data[RTC_DATE] = bin2bcd(tm->tm_mday);
- data[RTC_MONTH] = bin2bcd(tm->tm_mon);
- data[RTC_YEAR1] = bin2bcd(tm->tm_year % 100);
- data[RTC_YEAR2] = bin2bcd((tm->tm_year + 1900) / 100);
- }
- static int s5m_rtc_read_time(struct device *dev, struct rtc_time *tm)
- {
- struct s5m_rtc_info *info = dev_get_drvdata(dev);
- u8 data[info->regs->regs_count];
- int ret;
- if (info->device_type == S2MPS14X || info->device_type == S2MPS13X) {
- ret = regmap_update_bits(info->regmap,
- info->regs->rtc_udr_update,
- S2MPS_RTC_RUDR_MASK, S2MPS_RTC_RUDR_MASK);
- if (ret) {
- dev_err(dev,
- "Failed to prepare registers for time reading: %d\n",
- ret);
- return ret;
- }
- }
- ret = regmap_bulk_read(info->regmap, info->regs->time, data,
- info->regs->regs_count);
- if (ret < 0)
- return ret;
- switch (info->device_type) {
- case S5M8763X:
- s5m8763_data_to_tm(data, tm);
- break;
- case S5M8767X:
- case S2MPS14X:
- case S2MPS13X:
- s5m8767_data_to_tm(data, tm, info->rtc_24hr_mode);
- break;
- default:
- return -EINVAL;
- }
- dev_dbg(dev, "%s: %d/%d/%d %d:%d:%d(%d)\n", __func__,
- 1900 + tm->tm_year, 1 + tm->tm_mon, tm->tm_mday,
- tm->tm_hour, tm->tm_min, tm->tm_sec, tm->tm_wday);
- return rtc_valid_tm(tm);
- }
- static int s5m_rtc_set_time(struct device *dev, struct rtc_time *tm)
- {
- struct s5m_rtc_info *info = dev_get_drvdata(dev);
- u8 data[info->regs->regs_count];
- int ret = 0;
- switch (info->device_type) {
- case S5M8763X:
- s5m8763_tm_to_data(tm, data);
- break;
- case S5M8767X:
- case S2MPS14X:
- case S2MPS13X:
- ret = s5m8767_tm_to_data(tm, data);
- break;
- default:
- return -EINVAL;
- }
- if (ret < 0)
- return ret;
- dev_dbg(dev, "%s: %d/%d/%d %d:%d:%d(%d)\n", __func__,
- 1900 + tm->tm_year, 1 + tm->tm_mon, tm->tm_mday,
- tm->tm_hour, tm->tm_min, tm->tm_sec, tm->tm_wday);
- ret = regmap_raw_write(info->regmap, info->regs->time, data,
- info->regs->regs_count);
- if (ret < 0)
- return ret;
- ret = s5m8767_rtc_set_time_reg(info);
- return ret;
- }
- static int s5m_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alrm)
- {
- struct s5m_rtc_info *info = dev_get_drvdata(dev);
- u8 data[info->regs->regs_count];
- unsigned int val;
- int ret, i;
- ret = regmap_bulk_read(info->regmap, info->regs->alarm0, data,
- info->regs->regs_count);
- if (ret < 0)
- return ret;
- switch (info->device_type) {
- case S5M8763X:
- s5m8763_data_to_tm(data, &alrm->time);
- ret = regmap_read(info->regmap, S5M_ALARM0_CONF, &val);
- if (ret < 0)
- return ret;
- alrm->enabled = !!val;
- break;
- case S5M8767X:
- case S2MPS14X:
- case S2MPS13X:
- s5m8767_data_to_tm(data, &alrm->time, info->rtc_24hr_mode);
- alrm->enabled = 0;
- for (i = 0; i < info->regs->regs_count; i++) {
- if (data[i] & ALARM_ENABLE_MASK) {
- alrm->enabled = 1;
- break;
- }
- }
- break;
- default:
- return -EINVAL;
- }
- dev_dbg(dev, "%s: %d/%d/%d %d:%d:%d(%d)\n", __func__,
- 1900 + alrm->time.tm_year, 1 + alrm->time.tm_mon,
- alrm->time.tm_mday, alrm->time.tm_hour,
- alrm->time.tm_min, alrm->time.tm_sec,
- alrm->time.tm_wday);
- ret = s5m_check_peding_alarm_interrupt(info, alrm);
- return 0;
- }
- static int s5m_rtc_stop_alarm(struct s5m_rtc_info *info)
- {
- u8 data[info->regs->regs_count];
- int ret, i;
- struct rtc_time tm;
- ret = regmap_bulk_read(info->regmap, info->regs->alarm0, data,
- info->regs->regs_count);
- if (ret < 0)
- return ret;
- s5m8767_data_to_tm(data, &tm, info->rtc_24hr_mode);
- dev_dbg(info->dev, "%s: %d/%d/%d %d:%d:%d(%d)\n", __func__,
- 1900 + tm.tm_year, 1 + tm.tm_mon, tm.tm_mday,
- tm.tm_hour, tm.tm_min, tm.tm_sec, tm.tm_wday);
- switch (info->device_type) {
- case S5M8763X:
- ret = regmap_write(info->regmap, S5M_ALARM0_CONF, 0);
- break;
- case S5M8767X:
- case S2MPS14X:
- case S2MPS13X:
- for (i = 0; i < info->regs->regs_count; i++)
- data[i] &= ~ALARM_ENABLE_MASK;
- ret = regmap_raw_write(info->regmap, info->regs->alarm0, data,
- info->regs->regs_count);
- if (ret < 0)
- return ret;
- ret = s5m8767_rtc_set_alarm_reg(info);
- break;
- default:
- return -EINVAL;
- }
- return ret;
- }
- static int s5m_rtc_start_alarm(struct s5m_rtc_info *info)
- {
- int ret;
- u8 data[info->regs->regs_count];
- u8 alarm0_conf;
- struct rtc_time tm;
- ret = regmap_bulk_read(info->regmap, info->regs->alarm0, data,
- info->regs->regs_count);
- if (ret < 0)
- return ret;
- s5m8767_data_to_tm(data, &tm, info->rtc_24hr_mode);
- dev_dbg(info->dev, "%s: %d/%d/%d %d:%d:%d(%d)\n", __func__,
- 1900 + tm.tm_year, 1 + tm.tm_mon, tm.tm_mday,
- tm.tm_hour, tm.tm_min, tm.tm_sec, tm.tm_wday);
- switch (info->device_type) {
- case S5M8763X:
- alarm0_conf = 0x77;
- ret = regmap_write(info->regmap, S5M_ALARM0_CONF, alarm0_conf);
- break;
- case S5M8767X:
- case S2MPS14X:
- case S2MPS13X:
- data[RTC_SEC] |= ALARM_ENABLE_MASK;
- data[RTC_MIN] |= ALARM_ENABLE_MASK;
- data[RTC_HOUR] |= ALARM_ENABLE_MASK;
- data[RTC_WEEKDAY] &= ~ALARM_ENABLE_MASK;
- if (data[RTC_DATE] & 0x1f)
- data[RTC_DATE] |= ALARM_ENABLE_MASK;
- if (data[RTC_MONTH] & 0xf)
- data[RTC_MONTH] |= ALARM_ENABLE_MASK;
- if (data[RTC_YEAR1] & 0x7f)
- data[RTC_YEAR1] |= ALARM_ENABLE_MASK;
- ret = regmap_raw_write(info->regmap, info->regs->alarm0, data,
- info->regs->regs_count);
- if (ret < 0)
- return ret;
- ret = s5m8767_rtc_set_alarm_reg(info);
- break;
- default:
- return -EINVAL;
- }
- return ret;
- }
- static int s5m_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alrm)
- {
- struct s5m_rtc_info *info = dev_get_drvdata(dev);
- u8 data[info->regs->regs_count];
- int ret;
- switch (info->device_type) {
- case S5M8763X:
- s5m8763_tm_to_data(&alrm->time, data);
- break;
- case S5M8767X:
- case S2MPS14X:
- case S2MPS13X:
- s5m8767_tm_to_data(&alrm->time, data);
- break;
- default:
- return -EINVAL;
- }
- dev_dbg(dev, "%s: %d/%d/%d %d:%d:%d(%d)\n", __func__,
- 1900 + alrm->time.tm_year, 1 + alrm->time.tm_mon,
- alrm->time.tm_mday, alrm->time.tm_hour, alrm->time.tm_min,
- alrm->time.tm_sec, alrm->time.tm_wday);
- ret = s5m_rtc_stop_alarm(info);
- if (ret < 0)
- return ret;
- ret = regmap_raw_write(info->regmap, info->regs->alarm0, data,
- info->regs->regs_count);
- if (ret < 0)
- return ret;
- ret = s5m8767_rtc_set_alarm_reg(info);
- if (ret < 0)
- return ret;
- if (alrm->enabled)
- ret = s5m_rtc_start_alarm(info);
- return ret;
- }
- static int s5m_rtc_alarm_irq_enable(struct device *dev,
- unsigned int enabled)
- {
- struct s5m_rtc_info *info = dev_get_drvdata(dev);
- if (enabled)
- return s5m_rtc_start_alarm(info);
- else
- return s5m_rtc_stop_alarm(info);
- }
- static irqreturn_t s5m_rtc_alarm_irq(int irq, void *data)
- {
- struct s5m_rtc_info *info = data;
- rtc_update_irq(info->rtc_dev, 1, RTC_IRQF | RTC_AF);
- return IRQ_HANDLED;
- }
- static const struct rtc_class_ops s5m_rtc_ops = {
- .read_time = s5m_rtc_read_time,
- .set_time = s5m_rtc_set_time,
- .read_alarm = s5m_rtc_read_alarm,
- .set_alarm = s5m_rtc_set_alarm,
- .alarm_irq_enable = s5m_rtc_alarm_irq_enable,
- };
- static int s5m8767_rtc_init_reg(struct s5m_rtc_info *info)
- {
- u8 data[2];
- int ret;
- switch (info->device_type) {
- case S5M8763X:
- case S5M8767X:
- /* UDR update time. Default of 7.32 ms is too long. */
- ret = regmap_update_bits(info->regmap, S5M_RTC_UDR_CON,
- S5M_RTC_UDR_T_MASK, S5M_RTC_UDR_T_450_US);
- if (ret < 0)
- dev_err(info->dev, "%s: fail to change UDR time: %d\n",
- __func__, ret);
- /* Set RTC control register : Binary mode, 24hour mode */
- data[0] = (1 << BCD_EN_SHIFT) | (1 << MODEL24_SHIFT);
- data[1] = (0 << BCD_EN_SHIFT) | (1 << MODEL24_SHIFT);
- ret = regmap_raw_write(info->regmap, S5M_ALARM0_CONF, data, 2);
- break;
- case S2MPS14X:
- case S2MPS13X:
- data[0] = (0 << BCD_EN_SHIFT) | (1 << MODEL24_SHIFT);
- ret = regmap_write(info->regmap, info->regs->ctrl, data[0]);
- if (ret < 0)
- break;
- /*
- * Should set WUDR & (RUDR or AUDR) bits to high after writing
- * RTC_CTRL register like writing Alarm registers. We can't find
- * the description from datasheet but vendor code does that
- * really.
- */
- ret = s5m8767_rtc_set_alarm_reg(info);
- break;
- default:
- return -EINVAL;
- }
- info->rtc_24hr_mode = 1;
- if (ret < 0) {
- dev_err(info->dev, "%s: fail to write controlm reg(%d)\n",
- __func__, ret);
- return ret;
- }
- return ret;
- }
- static int s5m_rtc_probe(struct platform_device *pdev)
- {
- struct sec_pmic_dev *s5m87xx = dev_get_drvdata(pdev->dev.parent);
- struct sec_platform_data *pdata = s5m87xx->pdata;
- struct s5m_rtc_info *info;
- const struct regmap_config *regmap_cfg;
- int ret, alarm_irq;
- if (!pdata) {
- dev_err(pdev->dev.parent, "Platform data not supplied\n");
- return -ENODEV;
- }
- info = devm_kzalloc(&pdev->dev, sizeof(*info), GFP_KERNEL);
- if (!info)
- return -ENOMEM;
- switch (platform_get_device_id(pdev)->driver_data) {
- case S2MPS14X:
- case S2MPS13X:
- regmap_cfg = &s2mps14_rtc_regmap_config;
- info->regs = &s2mps_rtc_regs;
- alarm_irq = S2MPS14_IRQ_RTCA0;
- break;
- case S5M8763X:
- regmap_cfg = &s5m_rtc_regmap_config;
- info->regs = &s5m_rtc_regs;
- alarm_irq = S5M8763_IRQ_ALARM0;
- break;
- case S5M8767X:
- regmap_cfg = &s5m_rtc_regmap_config;
- info->regs = &s5m_rtc_regs;
- alarm_irq = S5M8767_IRQ_RTCA1;
- break;
- default:
- dev_err(&pdev->dev,
- "Device type %lu is not supported by RTC driver\n",
- platform_get_device_id(pdev)->driver_data);
- return -ENODEV;
- }
- info->i2c = i2c_new_dummy(s5m87xx->i2c->adapter, RTC_I2C_ADDR);
- if (!info->i2c) {
- dev_err(&pdev->dev, "Failed to allocate I2C for RTC\n");
- return -ENODEV;
- }
- info->regmap = devm_regmap_init_i2c(info->i2c, regmap_cfg);
- if (IS_ERR(info->regmap)) {
- ret = PTR_ERR(info->regmap);
- dev_err(&pdev->dev, "Failed to allocate RTC register map: %d\n",
- ret);
- goto err;
- }
- info->dev = &pdev->dev;
- info->s5m87xx = s5m87xx;
- info->device_type = platform_get_device_id(pdev)->driver_data;
- if (s5m87xx->irq_data) {
- info->irq = regmap_irq_get_virq(s5m87xx->irq_data, alarm_irq);
- if (info->irq <= 0) {
- ret = -EINVAL;
- dev_err(&pdev->dev, "Failed to get virtual IRQ %d\n",
- alarm_irq);
- goto err;
- }
- }
- platform_set_drvdata(pdev, info);
- ret = s5m8767_rtc_init_reg(info);
- device_init_wakeup(&pdev->dev, 1);
- info->rtc_dev = devm_rtc_device_register(&pdev->dev, "s5m-rtc",
- &s5m_rtc_ops, THIS_MODULE);
- if (IS_ERR(info->rtc_dev)) {
- ret = PTR_ERR(info->rtc_dev);
- goto err;
- }
- if (!info->irq) {
- dev_info(&pdev->dev, "Alarm IRQ not available\n");
- return 0;
- }
- ret = devm_request_threaded_irq(&pdev->dev, info->irq, NULL,
- s5m_rtc_alarm_irq, 0, "rtc-alarm0",
- info);
- if (ret < 0) {
- dev_err(&pdev->dev, "Failed to request alarm IRQ: %d: %d\n",
- info->irq, ret);
- goto err;
- }
- return 0;
- err:
- i2c_unregister_device(info->i2c);
- return ret;
- }
- static int s5m_rtc_remove(struct platform_device *pdev)
- {
- struct s5m_rtc_info *info = platform_get_drvdata(pdev);
- i2c_unregister_device(info->i2c);
- return 0;
- }
- #ifdef CONFIG_PM_SLEEP
- static int s5m_rtc_resume(struct device *dev)
- {
- struct s5m_rtc_info *info = dev_get_drvdata(dev);
- int ret = 0;
- if (info->irq && device_may_wakeup(dev))
- ret = disable_irq_wake(info->irq);
- return ret;
- }
- static int s5m_rtc_suspend(struct device *dev)
- {
- struct s5m_rtc_info *info = dev_get_drvdata(dev);
- int ret = 0;
- if (info->irq && device_may_wakeup(dev))
- ret = enable_irq_wake(info->irq);
- return ret;
- }
- #endif /* CONFIG_PM_SLEEP */
- static SIMPLE_DEV_PM_OPS(s5m_rtc_pm_ops, s5m_rtc_suspend, s5m_rtc_resume);
- static const struct platform_device_id s5m_rtc_id[] = {
- { "s5m-rtc", S5M8767X },
- { "s2mps13-rtc", S2MPS13X },
- { "s2mps14-rtc", S2MPS14X },
- { },
- };
- MODULE_DEVICE_TABLE(platform, s5m_rtc_id);
- static struct platform_driver s5m_rtc_driver = {
- .driver = {
- .name = "s5m-rtc",
- .pm = &s5m_rtc_pm_ops,
- },
- .probe = s5m_rtc_probe,
- .remove = s5m_rtc_remove,
- .id_table = s5m_rtc_id,
- };
- module_platform_driver(s5m_rtc_driver);
- /* Module information */
- MODULE_AUTHOR("Sangbeom Kim <sbkim73@samsung.com>");
- MODULE_DESCRIPTION("Samsung S5M/S2MPS14 RTC driver");
- MODULE_LICENSE("GPL");
- MODULE_ALIAS("platform:s5m-rtc");
|