static int __devinit max77686_rtc_init_reg(struct max77686_rtc_info *info, struct max77686_platform_data *pdata) { u8 data[2], update0, cntl; int ret; max77686_rtc_update(info, MAX77686_RTC_READ); ret = max77686_read_reg(info->rtc, MAX77686_RTC_CONTROL, &cntl); if (ret < 0) { dev_err(info->dev, "%s: fail to read control reg(%d)\n", __func__, ret); return ret; } ret = max77686_read_reg(info->rtc, MAX77686_RTC_UPDATE0, &update0); if (ret < 0) { dev_err(info->dev, "%s: fail to read update0 reg(%d)\n", __func__, ret); return ret; } info->update0_reg = update0 & ~(RTC_UDR_MASK | RTC_RBUDR_MASK); /* If the value of CONTROL register is 0, RTC registers were reset */ if (cntl == MODEL24_MASK) return 0; /* Set RTC control register : Binary mode, 24hour mode */ data[0] = BCD_EN_MASK | MODEL24_MASK; data[1] = MODEL24_MASK; ret = max77686_bulk_write(info->rtc, MAX77686_RTC_CONTROLM, 2, data); if (ret < 0) { dev_err(info->dev, "%s: fail to write controlm reg(%d)\n", __func__, ret); return ret; } ret = max77686_rtc_update(info, MAX77686_RTC_WRITE); if (ret < 0) return ret; if (pdata->init_time) { dev_info(info->dev, "%s: initialize RTC time\n", __func__); ret = max77686_rtc_set_time(info->dev, pdata->init_time); } return ret; }
static int max77686_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alrm) { struct max77686_rtc_info *info = dev_get_drvdata(dev); u8 data[NR_RTC_CNT_REGS], val; int ret; mutex_lock(&info->lock); ret = max77686_rtc_update(info, MAX77686_RTC_READ); if (ret < 0) goto out; ret = max77686_bulk_read(info->rtc, MAX77686_ALARM1_SEC, 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; } max77686_rtc_data_to_tm(data, &alrm->time); dev_dbg(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; ret = max77686_read_reg(info->max77686->i2c, MAX77686_REG_STATUS2, &val); if (ret < 0) { dev_err(info->dev, "%s:%d fail to read status1 reg(%d)\n", __func__, __LINE__, ret); goto out; } if (val & STATUS2_RTCA1_MASK) alrm->pending = 1; out: mutex_unlock(&info->lock); return ret; }
static int max77686_i2c_probe(struct i2c_client *i2c, const struct i2c_device_id *id) { struct max77686_dev *max77686; struct max77686_platform_data *pdata = i2c->dev.platform_data; u8 data; int ret = 0; max77686 = kzalloc(sizeof(struct max77686_dev), GFP_KERNEL); if (max77686 == NULL) return -ENOMEM; i2c_set_clientdata(i2c, max77686); max77686->dev = &i2c->dev; max77686->i2c = i2c; max77686->type = id->driver_data; if (!pdata) { ret = -EIO; goto err; } max77686->wakeup = pdata->wakeup; max77686->irq_gpio = pdata->irq_gpio; max77686->irq_base = pdata->irq_base; mutex_init(&max77686->iolock); if (max77686_read_reg(i2c, MAX77686_REG_DEVICE_ID, &data) < 0) { dev_err(max77686->dev, "device not found on this channel (this is not an error)\n"); ret = -ENODEV; goto err; } else dev_info(max77686->dev, "device found\n"); #ifdef CONFIG_RTC_DRV_MAX77686 max77686->rtc = i2c_new_dummy(i2c->adapter, I2C_ADDR_RTC); i2c_set_clientdata(max77686->rtc, max77686); #endif max77686_irq_init(max77686); ret = mfd_add_devices(max77686->dev, -1, max77686_devs, ARRAY_SIZE(max77686_devs), NULL, 0); if (ret < 0) goto err_mfd; device_init_wakeup(max77686->dev, pdata->wakeup); return ret; err_mfd: mfd_remove_devices(max77686->dev); #ifdef CONFIG_RTC_DRV_MAX77686 i2c_unregister_device(max77686->rtc); #endif err: kfree(max77686); return ret; }