/* * rtc-s2mpu09.c * * Copyright (c) 2016 Samsung Electronics Co., Ltd * http://www.samsung.com * * 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. * * 2013-12-11 Performance improvements and code clean up by * Minsung Kim * */ #include #include #include #include #include #include #include #include #include #include #include #if defined(CONFIG_RTC_ALARM_BOOT) #include #include #endif /*#define CONFIG_WEEKDAY_ALARM_ENABLE*/ struct s2m_rtc_info { struct device *dev; struct i2c_client *i2c; struct i2c_client *pmic_i2c; struct s2mpu09_dev *iodev; struct rtc_device *rtc_dev; struct mutex lock; struct work_struct irq_work; int irq; #if defined(CONFIG_RTC_ALARM_BOOT) int alarm_boot_irq; bool lpm_mode; bool alarm_irq_flag; struct wake_lock alarm_wake_lock; #endif bool use_irq; bool wtsr_en; bool smpl_en; bool alarm_enabled; u8 update_reg; bool use_alarm_workaround; bool alarm_check; u8 wudr_mask; u8 audr_mask; }; static struct wakeup_source *rtc_ws; #ifdef CONFIG_SEC_PM static bool is_rtc_cleared; #endif #if defined(CONFIG_BATTERY_SAMSUNG) extern unsigned int lpcharge; #endif enum S2M_RTC_OP { S2M_RTC_READ, S2M_RTC_WRITE_TIME, S2M_RTC_WRITE_ALARM, }; static void s2m_data_to_tm(u8 *data, struct rtc_time *tm) { // tm->tm_msec = (data[RTC_MSEC] & 0x0f) + (data[RTC_MSEC] & 0xf0) * 10; tm->tm_sec = data[RTC_SEC] & 0x7f; tm->tm_min = data[RTC_MIN] & 0x7f; tm->tm_hour = data[RTC_HOUR] & 0x1f; tm->tm_wday = __fls(data[RTC_WEEKDAY] & 0x7f); tm->tm_mday = data[RTC_DATE] & 0x1f; tm->tm_mon = (data[RTC_MONTH] & 0x0f) - 1; tm->tm_year = (data[RTC_YEAR] & 0x7f) + 100; tm->tm_yday = 0; tm->tm_isdst = 0; } #ifdef CONFIG_RTC_HIGH_RES static void s2m_data_to_hrtm(u8 *data, struct rtc_hrtime *tm) { tm->tm_msec = (data[RTC_HR_MSEC] & 0x7f) * 10; tm->tm_sec = data[RTC_HR_SEC] & 0x7f; tm->tm_min = data[RTC_HR_MIN] & 0x7f; tm->tm_hour = data[RTC_HR_HOUR] & 0x1f; tm->tm_wday = __fls(data[RTC_HR_WEEKDAY] & 0x7f); tm->tm_mday = data[RTC_HR_DATE] & 0x1f; tm->tm_mon = (data[RTC_HR_MONTH] & 0x0f) - 1; tm->tm_year = (data[RTC_HR_YEAR] & 0x7f) + 100; tm->tm_yday = 0; tm->tm_isdst = 0; } #endif /* CONFIG_RTC_HIGH_RES */ static int s2m_tm_to_data(struct rtc_time *tm, u8 *data) { // data[RTC_MSEC] = ((tm->tm_msec / 10) << 4) | (tm->tm_msec % 10); 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; data[RTC_WEEKDAY] = BIT(tm->tm_wday); data[RTC_DATE] = tm->tm_mday; data[RTC_MONTH] = tm->tm_mon + 1; data[RTC_YEAR] = tm->tm_year > 100 ? (tm->tm_year - 100) : 0 ; if (tm->tm_year < 100) { pr_warn("%s: SEC RTC cannot handle the year %d\n", __func__, 1900 + tm->tm_year); return -EINVAL; } return 0; } static int s2m_rtc_update(struct s2m_rtc_info *info, enum S2M_RTC_OP op) { u8 data; int ret; if (!info || !info->iodev) { pr_err("%s: Invalid argument\n", __func__); return -EINVAL; } switch (op) { case S2M_RTC_READ: data = RTC_RUDR_MASK; break; case S2M_RTC_WRITE_TIME: data = RTC_WUDR_MASK_REV; break; case S2M_RTC_WRITE_ALARM: data = RTC_AUDR_MASK_REV; break; default: dev_err(info->dev, "%s: invalid op(%d)\n", __func__, op); return -EINVAL; } data |= info->update_reg; ret = s2mpu09_write_reg(info->i2c, S2MP_RTC_REG_UPDATE, data); if (ret < 0) dev_err(info->dev, "%s: fail to write update reg(%d,%u)\n", __func__, ret, data); else usleep_range(1000, 1000); return ret; } static int s2m_rtc_read_time(struct device *dev, struct rtc_time *tm) { struct s2m_rtc_info *info = dev_get_drvdata(dev); u8 data[NR_RTC_CNT_REGS]; int ret; mutex_lock(&info->lock); ret = s2m_rtc_update(info, S2M_RTC_READ); if (ret < 0) goto out; ret = s2mpu09_bulk_read(info->i2c, S2MP_RTC_REG_SEC, NR_RTC_CNT_REGS, data); if (ret < 0) { dev_err(info->dev, "%s: fail to read time reg(%d)\n", __func__, ret); goto out; } dev_info(info->dev, "%s: %d-%02d-%02d %02d:%02d:%02d(0x%02x)%s\n", __func__, data[RTC_YEAR] + 2000, data[RTC_MONTH], data[RTC_DATE], data[RTC_HOUR] & 0x1f, data[RTC_MIN], data[RTC_SEC], data[RTC_WEEKDAY], data[RTC_HOUR] & HOUR_PM_MASK ? "PM" : "AM"); s2m_data_to_tm(data, tm); ret = rtc_valid_tm(tm); out: mutex_unlock(&info->lock); return ret; } #ifdef CONFIG_RTC_HIGH_RES static int s2m_rtc_read_hrtime(struct device *dev, struct rtc_hrtime *tm) { struct s2m_rtc_info *info = dev_get_drvdata(dev); u8 data[NR_RTC_HR_CNT_REGS]; int ret; mutex_lock(&info->lock); ret = s2m_rtc_update(info, S2M_RTC_READ); if (ret < 0) goto out; ret = s2mpu09_bulk_read(info->i2c, S2MP_RTC_REG_MSEC, NR_RTC_HR_CNT_REGS, data); if (ret < 0) { dev_err(info->dev, "%s: fail to read hrtime reg(%d)\n", __func__, ret); goto out; } pr_info("%s: RTC_MSEC: 0x%02X\n", __func__, data[RTC_HR_MSEC]); dev_info(info->dev, "%s: %d-%02d-%02d %02d:%02d:%02d.%03d(0x%02x)%s\n", __func__, data[RTC_HR_YEAR] + 2000, data[RTC_HR_MONTH], data[RTC_HR_DATE], data[RTC_HR_HOUR] & 0x1f, data[RTC_HR_MIN], data[RTC_HR_SEC], (data[RTC_HR_MSEC] & 0x7f) * 10, data[RTC_HR_WEEKDAY], data[RTC_HR_HOUR] & HOUR_PM_MASK ? "PM" : "AM"); s2m_data_to_hrtm(data, tm); ret = rtc_valid_hrtm(tm); out: mutex_unlock(&info->lock); return ret; } #endif /* CONFIG_RTC_HIGH_RES */ static int s2m_rtc_set_time(struct device *dev, struct rtc_time *tm) { struct s2m_rtc_info *info = dev_get_drvdata(dev); u8 data[NR_RTC_CNT_REGS]; int ret; ret = s2m_tm_to_data(tm, data); if (ret < 0) return ret; dev_info(info->dev, "%s: %d-%02d-%02d %02d:%02d:%02d(0x%02x)%s\n", __func__, data[RTC_YEAR] + 2000, data[RTC_MONTH], data[RTC_DATE], data[RTC_HOUR] & 0x1f, data[RTC_MIN], data[RTC_SEC], data[RTC_WEEKDAY], data[RTC_HOUR] & HOUR_PM_MASK ? "PM" : "AM"); mutex_lock(&info->lock); ret = s2mpu09_bulk_write(info->i2c, S2MP_RTC_REG_SEC, NR_RTC_CNT_REGS, data); if (ret < 0) { dev_err(info->dev, "%s: fail to write time reg(%d)\n", __func__, ret); goto out; } ret = s2m_rtc_update(info, S2M_RTC_WRITE_TIME); out: mutex_unlock(&info->lock); return ret; } /* This is a workaround for the problem that RTC TIME is overwirted by write * buffer when setting RTC ALARM. It is quite rare but it does happen. The root * cuase is that clear signal of RUDR & WUDR is 1 clock delay while it should be * 2 clock delay. */ static int s2m_rtc_check_rtc_time(struct s2m_rtc_info *info) { u8 data[NR_RTC_CNT_REGS]; struct rtc_time tm; struct timeval sys_time; unsigned long rtc_time; int ret; /* Read RTC TIME */ ret = s2m_rtc_update(info, S2M_RTC_READ); if (ret < 0) goto out; ret = s2mpu09_bulk_read(info->i2c, S2MP_RTC_REG_SEC, NR_RTC_CNT_REGS, data); if (ret < 0) { dev_err(info->dev, "%s: fail to read time reg(%d)\n", __func__, ret); goto out; } /* Get system time */ do_gettimeofday(&sys_time); /* Convert RTC TIME to seconds since 01-01-1970 00:00:00. */ s2m_data_to_tm(data, &tm); rtc_tm_to_time(&tm, &rtc_time); if (abs(rtc_time - sys_time.tv_sec) > 2) { /* Set RTC TIME */ rtc_time_to_tm(sys_time.tv_sec, &tm); ret = s2m_tm_to_data(&tm, data); if (ret < 0) { dev_err(info->dev, "%s: fail to tm_to_data(%d)\n", __func__, ret); goto out; } ret = s2mpu09_bulk_write(info->i2c, S2MP_RTC_REG_SEC, NR_RTC_CNT_REGS, data); if (ret < 0) { dev_err(info->dev, "%s: fail to write time reg(%d)\n", __func__, ret); goto out; } ret = s2m_rtc_update(info, S2M_RTC_WRITE_TIME); dev_warn(info->dev, "%s: adjust RTC TIME: sys_time: %lu, " "rtc_time: %lu\n", __func__, sys_time.tv_sec, rtc_time); dev_info(info->dev, "%s: %d-%02d-%02d %02d:%02d:%02d(0x%02x)%s\n", __func__, data[RTC_YEAR] + 2000, data[RTC_MONTH], data[RTC_DATE], data[RTC_HOUR] & 0x1f, data[RTC_MIN], data[RTC_SEC], data[RTC_WEEKDAY], data[RTC_HOUR] & HOUR_PM_MASK ? "PM" : "AM"); } out: return ret; } static int s2m_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alrm) { struct s2m_rtc_info *info = dev_get_drvdata(dev); u8 data[NR_RTC_CNT_REGS]; u8 reg, val; int ret; mutex_lock(&info->lock); ret = s2m_rtc_update(info, S2M_RTC_READ); if (ret < 0) goto out; ret = s2mpu09_bulk_read(info->i2c, S2MP_RTC_REG_A0SEC, NR_RTC_CNT_REGS, data); if (ret < 0) { dev_err(info->dev, "%s:%d fail to read alarm reg(%d)\n", __func__, __LINE__, ret); goto out; } s2m_data_to_tm(data, &alrm->time); dev_info(info->dev, "%s: %d-%02d-%02d %02d:%02d:%02d(%d)\n", __func__, alrm->time.tm_year + 1900, alrm->time.tm_mon + 1, alrm->time.tm_mday, alrm->time.tm_hour, alrm->time.tm_min, alrm->time.tm_sec, alrm->time.tm_wday); alrm->enabled = info->alarm_enabled; alrm->pending = 0; switch (info->iodev->device_type) { case S2MPU09X: reg = S2MPU09_PMIC_REG_STATUS2; break; default: /* If this happens the core funtion has a problem */ BUG(); } ret = s2mpu09_read_reg(info->pmic_i2c, reg, &val); /* i2c for PM */ if (ret < 0) { dev_err(info->dev, "%s:%d fail to read STATUS2 reg(%d)\n", __func__, __LINE__, ret); goto out; } if (val & RTCA0E) alrm->pending = 1; out: mutex_unlock(&info->lock); return ret; } static int s2m_rtc_set_alarm_enable(struct s2m_rtc_info *info, bool enabled) { if (!info->use_irq) return -EPERM; if (enabled && !info->alarm_enabled) { info->alarm_enabled = true; enable_irq(info->irq); } else if (!enabled && info->alarm_enabled) { info->alarm_enabled = false; disable_irq(info->irq); } return 0; } static int s2m_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alrm) { struct s2m_rtc_info *info = dev_get_drvdata(dev); u8 data[NR_RTC_CNT_REGS]; int ret, i; mutex_lock(&info->lock); ret = s2m_tm_to_data(&alrm->time, data); if (ret < 0) goto out; dev_info(info->dev, "%s: %d-%02d-%02d %02d:%02d:%02d(0x%02x)%s\n", __func__, data[RTC_YEAR] + 2000, data[RTC_MONTH], data[RTC_DATE], data[RTC_HOUR] & 0x1f, data[RTC_MIN], data[RTC_SEC], data[RTC_WEEKDAY], data[RTC_HOUR] & HOUR_PM_MASK ? "PM" : "AM"); if (info->alarm_check) { for (i = 0; i < NR_RTC_CNT_REGS; i++) data[i] &= ~ALARM_ENABLE_MASK; ret = s2mpu09_bulk_write(info->i2c, S2MP_RTC_REG_A0SEC, NR_RTC_CNT_REGS, data); if (ret < 0) { dev_err(info->dev, "%s: fail to disable alarm reg(%d)\n", __func__, ret); goto out; } ret = s2m_rtc_update(info, S2M_RTC_WRITE_ALARM); if (ret < 0) goto out; } for (i = 0; i < NR_RTC_CNT_REGS; i++) data[i] |= ALARM_ENABLE_MASK; ret = s2mpu09_bulk_write(info->i2c, S2MP_RTC_REG_A0SEC, NR_RTC_CNT_REGS, data); if (ret < 0) { dev_err(info->dev, "%s: fail to write alarm reg(%d)\n", __func__, ret); goto out; } ret = s2m_rtc_update(info, S2M_RTC_WRITE_ALARM); if (ret < 0) goto out; if (info->use_alarm_workaround) { ret = s2m_rtc_check_rtc_time(info); if (ret < 0) goto out; } ret = s2m_rtc_set_alarm_enable(info, alrm->enabled); out: mutex_unlock(&info->lock); return ret; } #if defined(CONFIG_RTC_ALARM_BOOT) static inline int s2m_rtc_set_update_reg(struct s2m_rtc_info *info,enum S2M_RTC_OP op) { int ret; u8 data; ret = s2mpu09_read_reg(info->i2c, S2MP_RTC_REG_UPDATE, &data); if (ret < 0) return ret; switch (op) { case S2M_RTC_READ: data |= RTC_RUDR_MASK; break; case S2M_RTC_WRITE_TIME: data |= info->wudr_mask; break; case S2M_RTC_WRITE_ALARM: data |= info->audr_mask; break; default: dev_err(info->dev, "%s: invalid op(%d)\n", __func__, op); return -EINVAL; } ret = s2mpu09_write_reg(info->i2c, S2MP_RTC_REG_UPDATE,data); if (ret < 0) { dev_err(info->dev, "%s: fail to write update reg(%d)\n", __func__, ret); } else { usleep_range(1000, 1000); } return ret; } static int s2m_rtc_stop_alarm_boot(struct s2m_rtc_info *info) { u8 data[7]; int ret, i; struct rtc_time tm; ret = s2mpu09_bulk_read(info->i2c, S2MP_RTC_REG_A1SEC, 7, data); if (ret < 0) return ret; s2m_data_to_tm(data, &tm); printk(KERN_INFO "%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); for (i = 0; i < 7; i++) data[i] &= ~ALARM_ENABLE_MASK; ret = s2mpu09_bulk_write(info->i2c, S2MP_RTC_REG_A1SEC, 7, data); if (ret < 0) return ret; ret = s2m_rtc_set_update_reg(info, S2M_RTC_WRITE_ALARM); return ret; } static int s2m_rtc_start_alarm_boot(struct s2m_rtc_info *info) { int ret; u8 data[7]; struct rtc_time tm; ret = s2mpu09_bulk_read(info->i2c, S2MP_RTC_REG_A1SEC, 7, data); if (ret < 0) return ret; s2m_data_to_tm(data, &tm); printk(KERN_INFO "%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); data[RTC_SEC] |= ALARM_ENABLE_MASK; data[RTC_MIN] |= ALARM_ENABLE_MASK; data[RTC_HOUR] |= ALARM_ENABLE_MASK; data[RTC_WEEKDAY] &= 0x00; 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_YEAR] & 0x7f) data[RTC_YEAR] |= ALARM_ENABLE_MASK; ret = s2mpu09_bulk_write(info->i2c, S2MP_RTC_REG_A1SEC, 7, data); if (ret < 0) return ret; ret = s2m_rtc_set_update_reg(info, S2M_RTC_WRITE_ALARM); return ret; } static int s2m_rtc_set_alarm_boot(struct device *dev, struct rtc_wkalrm *alrm) { struct s2m_rtc_info *info = dev_get_drvdata(dev); u8 data[7]; int ret; mutex_lock(&info->lock); s2m_tm_to_data(&alrm->time, data); dev_info(info->dev, "%s: %d-%02d-%02d %02d:%02d:%02d(0x%02x)%s\n", __func__, data[RTC_YEAR] + 2000, data[RTC_MONTH], data[RTC_DATE], data[RTC_HOUR] & 0x1f, data[RTC_MIN], data[RTC_SEC], data[RTC_WEEKDAY], data[RTC_HOUR] & HOUR_PM_MASK ? "PM" : "AM"); ret = s2m_rtc_stop_alarm_boot(info); if (ret < 0) return ret; ret = s2mpu09_read_reg(info->i2c, S2MP_RTC_REG_UPDATE, &info->update_reg); if (ret < 0) { printk(KERN_INFO "%s: read fail \n", __func__); return ret; } if (alrm->enabled) info->update_reg |= RTC_WAKE_MASK; else info->update_reg &= ~RTC_WAKE_MASK; ret = s2mpu09_write_reg(info->i2c, S2MP_RTC_REG_UPDATE, info->update_reg); if (ret < 0) { dev_err(info->dev, "%s: fail to write update reg(%d)\n", __func__, ret); } else { usleep_range(1000, 1000); } ret = s2mpu09_bulk_write(info->i2c, S2MP_RTC_REG_A1SEC, 7, data); if (ret < 0) return ret; ret = s2m_rtc_set_update_reg(info, S2M_RTC_WRITE_ALARM); if (ret < 0) return ret; if (alrm->enabled) ret = s2m_rtc_start_alarm_boot(info); mutex_unlock(&info->lock); return ret; } static int s2m_rtc_get_alarm_boot(struct device *dev, struct rtc_wkalrm *alrm) { struct s2m_rtc_info *info = dev_get_drvdata(dev); if( info->alarm_irq_flag) alrm->enabled = 0x1; else alrm->enabled = 0x0; printk("s2m_rtc_get_alarm_boot : %d, %d\n", info->lpm_mode, alrm->enabled); return info->lpm_mode; } #endif static int s2m_rtc_alarm_irq_enable(struct device *dev, unsigned int enabled) { struct s2m_rtc_info *info = dev_get_drvdata(dev); int ret; mutex_lock(&info->lock); ret = s2m_rtc_set_alarm_enable(info, enabled); mutex_unlock(&info->lock); return ret; } #if defined(CONFIG_RTC_ALARM_BOOT) static irqreturn_t s2m_rtc_alarm1_irq(int irq, void *data) { struct s2m_rtc_info *info = data; dev_info(info->dev, "%s:irq(%d), lpm_mode:(%d)\n", __func__, irq, info->lpm_mode); if (info->lpm_mode) { wake_lock(&info->alarm_wake_lock); info->alarm_irq_flag = true; } rtc_update_irq(info->rtc_dev, 1, RTC_IRQF | RTC_AF); return IRQ_HANDLED; } #endif static irqreturn_t s2m_rtc_alarm_irq(int irq, void *data) { struct s2m_rtc_info *info = data; if (!info->rtc_dev) return IRQ_HANDLED; dev_info(info->dev, "%s:irq(%d)\n", __func__, irq); rtc_update_irq(info->rtc_dev, 1, RTC_IRQF | RTC_AF); __pm_wakeup_event(rtc_ws, 500); return IRQ_HANDLED; } static const struct rtc_class_ops s2m_rtc_ops = { .read_time = s2m_rtc_read_time, .read_hrtime = s2m_rtc_read_hrtime, .set_time = s2m_rtc_set_time, .read_alarm = s2m_rtc_read_alarm, .set_alarm = s2m_rtc_set_alarm, #if defined(CONFIG_RTC_ALARM_BOOT) .set_alarm_boot = s2m_rtc_set_alarm_boot, .get_alarm_boot = s2m_rtc_get_alarm_boot, #endif .alarm_irq_enable = s2m_rtc_alarm_irq_enable, }; static void s2m_rtc_optimize_osc(struct s2m_rtc_info *info, struct s2mpu09_platform_data *pdata) { int ret = 0; /* edit option for OSC_BIAS_UP */ if (pdata->osc_bias_up >= 0) { ret = s2mpu09_update_reg(info->i2c, S2MP_RTC_REG_CAPSEL, pdata->osc_bias_up << OSC_BIAS_UP_SHIFT, OSC_BIAS_UP_MASK); if (ret < 0) { dev_err(info->dev, "%s: fail to write OSC_BIAS_UP(%d)\n", __func__, pdata->osc_bias_up); return; } } /* edit option for CAP_SEL */ if (pdata->cap_sel >= 0) { s2mpu09_update_reg(info->i2c, S2MP_RTC_REG_CAPSEL, pdata->cap_sel << CAP_SEL_SHIFT, CAP_SEL_MASK); if (ret < 0) { dev_err(info->dev, "%s: fail to write CAP_SEL(%d)\n", __func__, pdata->cap_sel); return; } } /* edit option for OSC_CTRL */ if (pdata->osc_xin >= 0) { s2mpu09_update_reg(info->i2c, S2MP_RTC_REG_OSCCTRL, pdata->osc_xin << OSC_XIN_SHIFT, OSC_XIN_MASK); if (ret < 0) { dev_err(info->dev, "%s: fail to write OSC_CTRL(%d)\n", __func__, pdata->osc_xin); return; } } if (pdata->osc_xout >= 0) { s2mpu09_update_reg(info->i2c, S2MP_RTC_REG_OSCCTRL, pdata->osc_xout << OSC_XOUT_SHIFT, OSC_XOUT_MASK); if (ret < 0) { dev_err(info->dev, "%s: fail to write OSC_CTRL(%d)\n", __func__, pdata->osc_xout); return; } } } static bool s2m_is_jigonb_low(struct s2m_rtc_info *info) { int ret, reg; u8 val, mask; switch (info->iodev->device_type) { case S2MPU09X: reg = S2MPU09_PMIC_REG_STATUS1; mask = BIT(1); break; default: BUG(); } ret = s2mpu09_read_reg(info->i2c, reg, &val); if (ret < 0) { dev_err(info->dev, "%s: fail to read status1 reg(%d)\n", __func__, ret); return false; } return !(val & mask); } static void s2m_rtc_enable_wtsr_smpl(struct s2m_rtc_info *info, struct s2mpu09_platform_data *pdata) { u8 val; int ret; if (pdata->wtsr_smpl->check_jigon && s2m_is_jigonb_low(info)) pdata->wtsr_smpl->smpl_en = false; val = (pdata->wtsr_smpl->wtsr_en << WTSR_EN_SHIFT) | (pdata->wtsr_smpl->smpl_en << SMPL_EN_SHIFT) | WTSR_TIMER_BITS(pdata->wtsr_smpl->wtsr_timer_val) | SMPL_TIMER_BITS(pdata->wtsr_smpl->smpl_timer_val); dev_info(info->dev, "%s: WTSR: %s, SMPL: %s\n", __func__, pdata->wtsr_smpl->wtsr_en ? "enable" : "disable", pdata->wtsr_smpl->smpl_en ? "enable" : "disable"); ret = s2mpu09_write_reg(info->i2c, S2MP_RTC_REG_WTSR_SMPL, val); if (ret < 0) { dev_err(info->dev, "%s: fail to write WTSR/SMPL reg(%d)\n", __func__, ret); return; } info->wtsr_en = pdata->wtsr_smpl->wtsr_en; info->smpl_en = pdata->wtsr_smpl->smpl_en; } static void s2m_rtc_disable_wtsr_smpl(struct s2m_rtc_info *info, struct s2mpu09_platform_data *pdata) { int ret; dev_info(info->dev, "%s: disable WTSR\n", __func__); ret = s2mpu09_update_reg(info->i2c, S2MP_RTC_REG_WTSR_SMPL, 0, WTSR_EN_MASK | SMPL_EN_MASK); if (ret < 0) dev_err(info->dev, "%s: fail to update WTSR reg(%d)\n", __func__, ret); } static int s2m_rtc_init_reg(struct s2m_rtc_info *info, struct s2mpu09_platform_data *pdata) { u8 data, update_val, ctrl_val, capsel_val; int ret; #if defined(CONFIG_RTC_ALARM_BOOT) u8 data_alm1[7]; struct rtc_time alrm; ret = s2mpu09_bulk_read(info->i2c, S2MP_RTC_REG_A1SEC, 7, data_alm1); if (ret < 0) return ret; s2m_data_to_tm(data_alm1, &alrm); printk(KERN_INFO "%s: %d/%d/%d %d:%d:%d(%d)\n", __func__, 1900 + alrm.tm_year, 1 + alrm.tm_mon, alrm.tm_mday, alrm.tm_hour, alrm.tm_min, alrm.tm_sec, alrm.tm_wday); #endif ret = s2mpu09_read_reg(info->i2c, S2MP_RTC_REG_UPDATE, &update_val); if (ret < 0) { dev_err(info->dev, "%s: fail to read update reg(%d)\n", __func__, ret); return ret; } info->update_reg = update_val & ~(RTC_WUDR_MASK_REV | RTC_FREEZE_MASK | RTC_RUDR_MASK | RTC_AUDR_MASK_REV); ret = s2mpu09_write_reg(info->i2c, S2MP_RTC_REG_UPDATE, info->update_reg); if (ret < 0) { dev_err(info->dev, "%s: fail to write update reg(%d)\n", __func__, ret); return ret; } s2m_rtc_update(info, S2M_RTC_READ); ret = s2mpu09_read_reg(info->i2c, S2MP_RTC_REG_CTRL, &ctrl_val); if (ret < 0) { dev_err(info->dev, "%s: fail to read control reg(%d)\n", __func__, ret); return ret; } ret = s2mpu09_read_reg(info->i2c, S2MP_RTC_REG_CAPSEL, &capsel_val); if (ret < 0) { dev_err(info->dev, "%s: fail to read cap_sel reg(%d)\n", __func__, ret); return ret; } /* If the value of RTC_CTRL register is 0, RTC registers were reset */ if ((ctrl_val & MODEL24_MASK) && ((capsel_val & 0xf0) == 0xf0)) return 0; #ifdef CONFIG_SEC_PM is_rtc_cleared = true; #endif /* Set RTC control register : Binary mode, 24hour mode */ data = MODEL24_MASK; ret = s2mpu09_write_reg(info->i2c, S2MP_RTC_REG_CTRL, data); if (ret < 0) { dev_err(info->dev, "%s: fail to write CTRL reg(%d)\n", __func__, ret); return ret; } ret = s2m_rtc_update(info, S2M_RTC_WRITE_ALARM); if (ret < 0) return ret; capsel_val |= 0xf0; ret = s2mpu09_write_reg(info->i2c, S2MP_RTC_REG_CAPSEL, capsel_val); if (ret < 0) { dev_err(info->dev, "%s: fail to write CAP_SEL reg(%d)\n", __func__, ret); return ret; } if (pdata->init_time) { dev_info(info->dev, "%s: initialize RTC time\n", __func__); ret = s2m_rtc_set_time(info->dev, pdata->init_time); } else { dev_info(info->dev, "%s: RTC initialize is not operated: " "This causes a weekday problem\n", __func__); } return ret; } #ifdef CONFIG_SEC_PM static ssize_t show_rtc_status(struct device *dev, struct device_attribute *attr, char *buf) { return sprintf(buf, "%u\n", is_rtc_cleared); } static DEVICE_ATTR(rtc_status, 0440, show_rtc_status, NULL); #endif static int s2m_rtc_probe(struct platform_device *pdev) { struct s2mpu09_dev *iodev = dev_get_drvdata(pdev->dev.parent); struct s2mpu09_platform_data *pdata = dev_get_platdata(iodev->dev); struct s2m_rtc_info *info; int irq_base; int ret = 0; info = devm_kzalloc(&pdev->dev, sizeof(struct s2m_rtc_info), GFP_KERNEL); if (!info) return -ENOMEM; irq_base = pdata->irq_base; if (!irq_base) { dev_err(&pdev->dev, "Failed to get irq base %d\n", irq_base); return -ENODEV; } mutex_init(&info->lock); info->dev = &pdev->dev; info->iodev = iodev; info->i2c = iodev->rtc; info->pmic_i2c = iodev->pmic; info->alarm_check = true; info->use_alarm_workaround = false; info->wudr_mask = RTC_WUDR_MASK_REV; info->audr_mask = RTC_AUDR_MASK_REV; switch (info->iodev->device_type) { case S2MPU09X: info->irq = irq_base + S2MPU09_PMIC_IRQ_RTCA0_INT2; #if defined(CONFIG_RTC_ALARM_BOOT) info->alarm_boot_irq = irq_base + S2MPU09_PMIC_IRQ_RTCA1_INT2; #endif break; default: /* If this happens the core funtion has a problem */ BUG(); } platform_set_drvdata(pdev, info); ret = s2m_rtc_init_reg(info, pdata); if (ret < 0) { dev_err(&pdev->dev, "Failed to initialize RTC reg:%d\n", ret); goto err_rtc_init_reg; } /* enable wtsrm smpl */ if (pdata->wtsr_smpl) s2m_rtc_enable_wtsr_smpl(info, pdata); s2m_rtc_optimize_osc(info, pdata); device_init_wakeup(&pdev->dev, true); rtc_ws = wakeup_source_register("rtc-s2mp"); ret = devm_request_threaded_irq(&pdev->dev, info->irq, NULL, s2m_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_rtc_irq; } disable_irq(info->irq); disable_irq(info->irq); info->use_irq = true; info->rtc_dev = devm_rtc_device_register(&pdev->dev, "s2mp-rtc", &s2m_rtc_ops, THIS_MODULE); if (IS_ERR(info->rtc_dev)) { ret = PTR_ERR(info->rtc_dev); dev_err(&pdev->dev, "Failed to register RTC device: %d\n", ret); goto err_rtc_dev_register; } enable_irq(info->irq); #ifdef CONFIG_SEC_PM ret = sysfs_create_file(power_kobj, &dev_attr_rtc_status.attr); if (ret) dev_err(&pdev->dev, "%s: failed to create rtc_status(%d)\n", __func__, ret); #endif #if defined(CONFIG_RTC_ALARM_BOOT) ret = devm_request_threaded_irq(&pdev->dev, info->alarm_boot_irq, NULL, s2m_rtc_alarm1_irq, 0, "rtc-alarm1", info); if (ret < 0) dev_err(&pdev->dev, "Failed to request alarm IRQ: %d: %d\n", info->alarm_boot_irq, ret); info->lpm_mode = lpcharge; if(info->lpm_mode) wake_lock_init(&info->alarm_wake_lock, WAKE_LOCK_SUSPEND, "alarm_wake_lock"); #endif return 0; err_rtc_dev_register: devm_free_irq(&pdev->dev, info->irq, info); enable_irq(info->irq); enable_irq(info->irq); err_rtc_irq: wakeup_source_unregister(rtc_ws); err_rtc_init_reg: platform_set_drvdata(pdev, NULL); mutex_destroy(&info->lock); return ret; } static int s2m_rtc_remove(struct platform_device *pdev) { struct s2m_rtc_info *info = platform_get_drvdata(pdev); if (!info->alarm_enabled) enable_irq(info->irq); #if defined(CONFIG_RTC_ALARM_BOOT) free_irq(info->alarm_boot_irq, info); #endif wakeup_source_unregister(rtc_ws); return 0; } static void s2m_rtc_shutdown(struct platform_device *pdev) { /*disable wtsr, smpl */ struct s2m_rtc_info *info = platform_get_drvdata(pdev); struct s2mpu09_platform_data *pdata = dev_get_platdata(info->iodev->dev); if (info->wtsr_en || info->smpl_en) s2m_rtc_disable_wtsr_smpl(info, pdata); } static const struct platform_device_id s2m_rtc_id[] = { { "s2mpu09-rtc", 0 }, }; static struct platform_driver s2m_rtc_driver = { .driver = { .name = "s2mpu09-rtc", .owner = THIS_MODULE, }, .probe = s2m_rtc_probe, .remove = s2m_rtc_remove, .shutdown = s2m_rtc_shutdown, .id_table = s2m_rtc_id, }; module_platform_driver(s2m_rtc_driver); /* Module information */ MODULE_DESCRIPTION("Samsung RTC driver"); MODULE_AUTHOR("Samsung Electronics"); MODULE_LICENSE("GPL");