1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17#include <linux/kernel.h>
18#include <linux/errno.h>
19#include <linux/init.h>
20#include <linux/module.h>
21#include <linux/types.h>
22#include <linux/rtc.h>
23#include <linux/bcd.h>
24#include <linux/math64.h>
25#include <linux/platform_device.h>
26#include <linux/interrupt.h>
27#include <linux/mfd/tps65910.h>
28
29struct tps65910_rtc {
30 struct rtc_device *rtc;
31 int irq;
32};
33
34
35#define NUM_TIME_REGS (TPS65910_YEARS - TPS65910_SECONDS + 1)
36
37
38#define NUM_COMP_REGS (TPS65910_RTC_COMP_MSB - TPS65910_RTC_COMP_LSB + 1)
39
40
41#define MIN_OFFSET (-277761)
42#define MAX_OFFSET (277778)
43
44
45#define TICKS_PER_HOUR (32768 * 3600)
46
47
48#define PPB_MULT (1000000000LL)
49
50static int tps65910_rtc_alarm_irq_enable(struct device *dev,
51 unsigned int enabled)
52{
53 struct tps65910 *tps = dev_get_drvdata(dev->parent);
54 u8 val = 0;
55
56 if (enabled)
57 val = TPS65910_RTC_INTERRUPTS_IT_ALARM;
58
59 return regmap_write(tps->regmap, TPS65910_RTC_INTERRUPTS, val);
60}
61
62
63
64
65
66
67
68
69
70
71static int tps65910_rtc_read_time(struct device *dev, struct rtc_time *tm)
72{
73 unsigned char rtc_data[NUM_TIME_REGS];
74 struct tps65910 *tps = dev_get_drvdata(dev->parent);
75 int ret;
76
77
78 ret = regmap_update_bits(tps->regmap, TPS65910_RTC_CTRL,
79 TPS65910_RTC_CTRL_GET_TIME, TPS65910_RTC_CTRL_GET_TIME);
80 if (ret < 0) {
81 dev_err(dev, "RTC CTRL reg update failed with err:%d\n", ret);
82 return ret;
83 }
84
85 ret = regmap_bulk_read(tps->regmap, TPS65910_SECONDS, rtc_data,
86 NUM_TIME_REGS);
87 if (ret < 0) {
88 dev_err(dev, "reading from RTC failed with err:%d\n", ret);
89 return ret;
90 }
91
92 tm->tm_sec = bcd2bin(rtc_data[0]);
93 tm->tm_min = bcd2bin(rtc_data[1]);
94 tm->tm_hour = bcd2bin(rtc_data[2]);
95 tm->tm_mday = bcd2bin(rtc_data[3]);
96 tm->tm_mon = bcd2bin(rtc_data[4]) - 1;
97 tm->tm_year = bcd2bin(rtc_data[5]) + 100;
98
99 return ret;
100}
101
102static int tps65910_rtc_set_time(struct device *dev, struct rtc_time *tm)
103{
104 unsigned char rtc_data[NUM_TIME_REGS];
105 struct tps65910 *tps = dev_get_drvdata(dev->parent);
106 int ret;
107
108 rtc_data[0] = bin2bcd(tm->tm_sec);
109 rtc_data[1] = bin2bcd(tm->tm_min);
110 rtc_data[2] = bin2bcd(tm->tm_hour);
111 rtc_data[3] = bin2bcd(tm->tm_mday);
112 rtc_data[4] = bin2bcd(tm->tm_mon + 1);
113 rtc_data[5] = bin2bcd(tm->tm_year - 100);
114
115
116 ret = regmap_update_bits(tps->regmap, TPS65910_RTC_CTRL,
117 TPS65910_RTC_CTRL_STOP_RTC, 0);
118 if (ret < 0) {
119 dev_err(dev, "RTC stop failed with err:%d\n", ret);
120 return ret;
121 }
122
123
124 ret = regmap_bulk_write(tps->regmap, TPS65910_SECONDS, rtc_data,
125 NUM_TIME_REGS);
126 if (ret < 0) {
127 dev_err(dev, "rtc_set_time error %d\n", ret);
128 return ret;
129 }
130
131
132 ret = regmap_update_bits(tps->regmap, TPS65910_RTC_CTRL,
133 TPS65910_RTC_CTRL_STOP_RTC, 1);
134 if (ret < 0)
135 dev_err(dev, "RTC start failed with err:%d\n", ret);
136
137 return ret;
138}
139
140
141
142
143static int tps65910_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alm)
144{
145 unsigned char alarm_data[NUM_TIME_REGS];
146 u32 int_val;
147 struct tps65910 *tps = dev_get_drvdata(dev->parent);
148 int ret;
149
150 ret = regmap_bulk_read(tps->regmap, TPS65910_SECONDS, alarm_data,
151 NUM_TIME_REGS);
152 if (ret < 0) {
153 dev_err(dev, "rtc_read_alarm error %d\n", ret);
154 return ret;
155 }
156
157 alm->time.tm_sec = bcd2bin(alarm_data[0]);
158 alm->time.tm_min = bcd2bin(alarm_data[1]);
159 alm->time.tm_hour = bcd2bin(alarm_data[2]);
160 alm->time.tm_mday = bcd2bin(alarm_data[3]);
161 alm->time.tm_mon = bcd2bin(alarm_data[4]) - 1;
162 alm->time.tm_year = bcd2bin(alarm_data[5]) + 100;
163
164 ret = regmap_read(tps->regmap, TPS65910_RTC_INTERRUPTS, &int_val);
165 if (ret < 0)
166 return ret;
167
168 if (int_val & TPS65910_RTC_INTERRUPTS_IT_ALARM)
169 alm->enabled = 1;
170
171 return ret;
172}
173
174static int tps65910_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alm)
175{
176 unsigned char alarm_data[NUM_TIME_REGS];
177 struct tps65910 *tps = dev_get_drvdata(dev->parent);
178 int ret;
179
180 ret = tps65910_rtc_alarm_irq_enable(dev, 0);
181 if (ret)
182 return ret;
183
184 alarm_data[0] = bin2bcd(alm->time.tm_sec);
185 alarm_data[1] = bin2bcd(alm->time.tm_min);
186 alarm_data[2] = bin2bcd(alm->time.tm_hour);
187 alarm_data[3] = bin2bcd(alm->time.tm_mday);
188 alarm_data[4] = bin2bcd(alm->time.tm_mon + 1);
189 alarm_data[5] = bin2bcd(alm->time.tm_year - 100);
190
191
192 ret = regmap_bulk_write(tps->regmap, TPS65910_ALARM_SECONDS,
193 alarm_data, NUM_TIME_REGS);
194 if (ret) {
195 dev_err(dev, "rtc_set_alarm error %d\n", ret);
196 return ret;
197 }
198
199 if (alm->enabled)
200 ret = tps65910_rtc_alarm_irq_enable(dev, 1);
201
202 return ret;
203}
204
205static int tps65910_rtc_set_calibration(struct device *dev, int calibration)
206{
207 unsigned char comp_data[NUM_COMP_REGS];
208 struct tps65910 *tps = dev_get_drvdata(dev->parent);
209 s16 value;
210 int ret;
211
212
213
214
215
216
217
218
219
220
221
222 if ((calibration < -32768) || (calibration > 32766)) {
223 dev_err(dev, "RTC calibration value out of range: %d\n",
224 calibration);
225 return -EINVAL;
226 }
227
228 value = (s16)calibration;
229
230 comp_data[0] = (u16)value & 0xFF;
231 comp_data[1] = ((u16)value >> 8) & 0xFF;
232
233
234 ret = regmap_bulk_write(tps->regmap, TPS65910_RTC_COMP_LSB,
235 comp_data, NUM_COMP_REGS);
236 if (ret < 0) {
237 dev_err(dev, "rtc_set_calibration error: %d\n", ret);
238 return ret;
239 }
240
241
242 ret = regmap_update_bits(tps->regmap, TPS65910_RTC_CTRL,
243 TPS65910_RTC_CTRL_AUTO_COMP, TPS65910_RTC_CTRL_AUTO_COMP);
244 if (ret < 0)
245 dev_err(dev, "auto_comp enable failed with error: %d\n", ret);
246
247 return ret;
248}
249
250static int tps65910_rtc_get_calibration(struct device *dev, int *calibration)
251{
252 unsigned char comp_data[NUM_COMP_REGS];
253 struct tps65910 *tps = dev_get_drvdata(dev->parent);
254 unsigned int ctrl;
255 u16 value;
256 int ret;
257
258 ret = regmap_read(tps->regmap, TPS65910_RTC_CTRL, &ctrl);
259 if (ret < 0)
260 return ret;
261
262
263 if (!(ctrl & TPS65910_RTC_CTRL_AUTO_COMP)) {
264 *calibration = 0;
265 return 0;
266 }
267
268 ret = regmap_bulk_read(tps->regmap, TPS65910_RTC_COMP_LSB, comp_data,
269 NUM_COMP_REGS);
270 if (ret < 0) {
271 dev_err(dev, "rtc_get_calibration error: %d\n", ret);
272 return ret;
273 }
274
275 value = (u16)comp_data[0] | ((u16)comp_data[1] << 8);
276
277 *calibration = (s16)value;
278
279 return 0;
280}
281
282static int tps65910_read_offset(struct device *dev, long *offset)
283{
284 int calibration;
285 s64 tmp;
286 int ret;
287
288 ret = tps65910_rtc_get_calibration(dev, &calibration);
289 if (ret < 0)
290 return ret;
291
292
293 tmp = calibration * (s64)PPB_MULT;
294 if (tmp < 0)
295 tmp -= TICKS_PER_HOUR / 2LL;
296 else
297 tmp += TICKS_PER_HOUR / 2LL;
298 tmp = div_s64(tmp, TICKS_PER_HOUR);
299
300
301 *offset = (long)-tmp;
302
303 return 0;
304}
305
306static int tps65910_set_offset(struct device *dev, long offset)
307{
308 int calibration;
309 s64 tmp;
310 int ret;
311
312
313 if (offset < MIN_OFFSET || offset > MAX_OFFSET)
314 return -ERANGE;
315
316
317 tmp = offset * (s64)TICKS_PER_HOUR;
318 if (tmp < 0)
319 tmp -= PPB_MULT / 2LL;
320 else
321 tmp += PPB_MULT / 2LL;
322 tmp = div_s64(tmp, PPB_MULT);
323
324
325 calibration = (int)-tmp;
326
327 ret = tps65910_rtc_set_calibration(dev, calibration);
328
329 return ret;
330}
331
332static irqreturn_t tps65910_rtc_interrupt(int irq, void *rtc)
333{
334 struct device *dev = rtc;
335 unsigned long events = 0;
336 struct tps65910 *tps = dev_get_drvdata(dev->parent);
337 struct tps65910_rtc *tps_rtc = dev_get_drvdata(dev);
338 int ret;
339 u32 rtc_reg;
340
341 ret = regmap_read(tps->regmap, TPS65910_RTC_STATUS, &rtc_reg);
342 if (ret)
343 return IRQ_NONE;
344
345 if (rtc_reg & TPS65910_RTC_STATUS_ALARM)
346 events = RTC_IRQF | RTC_AF;
347
348 ret = regmap_write(tps->regmap, TPS65910_RTC_STATUS, rtc_reg);
349 if (ret)
350 return IRQ_NONE;
351
352
353 rtc_update_irq(tps_rtc->rtc, 1, events);
354
355 return IRQ_HANDLED;
356}
357
358static const struct rtc_class_ops tps65910_rtc_ops = {
359 .read_time = tps65910_rtc_read_time,
360 .set_time = tps65910_rtc_set_time,
361 .read_alarm = tps65910_rtc_read_alarm,
362 .set_alarm = tps65910_rtc_set_alarm,
363 .alarm_irq_enable = tps65910_rtc_alarm_irq_enable,
364 .read_offset = tps65910_read_offset,
365 .set_offset = tps65910_set_offset,
366};
367
368static int tps65910_rtc_probe(struct platform_device *pdev)
369{
370 struct tps65910 *tps65910 = NULL;
371 struct tps65910_rtc *tps_rtc = NULL;
372 int ret;
373 int irq;
374 u32 rtc_reg;
375
376 tps65910 = dev_get_drvdata(pdev->dev.parent);
377
378 tps_rtc = devm_kzalloc(&pdev->dev, sizeof(struct tps65910_rtc),
379 GFP_KERNEL);
380 if (!tps_rtc)
381 return -ENOMEM;
382
383 tps_rtc->rtc = devm_rtc_allocate_device(&pdev->dev);
384 if (IS_ERR(tps_rtc->rtc))
385 return PTR_ERR(tps_rtc->rtc);
386
387
388 ret = regmap_read(tps65910->regmap, TPS65910_RTC_STATUS, &rtc_reg);
389 if (ret < 0)
390 return ret;
391
392 ret = regmap_write(tps65910->regmap, TPS65910_RTC_STATUS, rtc_reg);
393 if (ret < 0)
394 return ret;
395
396 dev_dbg(&pdev->dev, "Enabling rtc-tps65910.\n");
397
398
399 ret = regmap_update_bits(tps65910->regmap, TPS65910_DEVCTRL,
400 DEVCTRL_RTC_PWDN_MASK, 0 << DEVCTRL_RTC_PWDN_SHIFT);
401 if (ret < 0)
402 return ret;
403
404 rtc_reg = TPS65910_RTC_CTRL_STOP_RTC;
405 ret = regmap_write(tps65910->regmap, TPS65910_RTC_CTRL, rtc_reg);
406 if (ret < 0)
407 return ret;
408
409 platform_set_drvdata(pdev, tps_rtc);
410
411 irq = platform_get_irq(pdev, 0);
412 if (irq <= 0) {
413 dev_warn(&pdev->dev, "Wake up is not possible as irq = %d\n",
414 irq);
415 return -ENXIO;
416 }
417
418 ret = devm_request_threaded_irq(&pdev->dev, irq, NULL,
419 tps65910_rtc_interrupt, IRQF_TRIGGER_LOW,
420 dev_name(&pdev->dev), &pdev->dev);
421 if (ret < 0) {
422 dev_err(&pdev->dev, "IRQ is not free.\n");
423 return ret;
424 }
425 tps_rtc->irq = irq;
426 device_set_wakeup_capable(&pdev->dev, 1);
427
428 tps_rtc->rtc->ops = &tps65910_rtc_ops;
429 tps_rtc->rtc->range_min = RTC_TIMESTAMP_BEGIN_2000;
430 tps_rtc->rtc->range_max = RTC_TIMESTAMP_END_2099;
431
432 ret = rtc_register_device(tps_rtc->rtc);
433 if (ret) {
434 dev_err(&pdev->dev, "RTC device register: err %d\n", ret);
435 return ret;
436 }
437
438 return 0;
439}
440
441#ifdef CONFIG_PM_SLEEP
442static int tps65910_rtc_suspend(struct device *dev)
443{
444 struct tps65910_rtc *tps_rtc = dev_get_drvdata(dev);
445
446 if (device_may_wakeup(dev))
447 enable_irq_wake(tps_rtc->irq);
448 return 0;
449}
450
451static int tps65910_rtc_resume(struct device *dev)
452{
453 struct tps65910_rtc *tps_rtc = dev_get_drvdata(dev);
454
455 if (device_may_wakeup(dev))
456 disable_irq_wake(tps_rtc->irq);
457 return 0;
458}
459#endif
460
461static SIMPLE_DEV_PM_OPS(tps65910_rtc_pm_ops, tps65910_rtc_suspend,
462 tps65910_rtc_resume);
463
464static struct platform_driver tps65910_rtc_driver = {
465 .probe = tps65910_rtc_probe,
466 .driver = {
467 .name = "tps65910-rtc",
468 .pm = &tps65910_rtc_pm_ops,
469 },
470};
471
472module_platform_driver(tps65910_rtc_driver);
473MODULE_ALIAS("platform:rtc-tps65910");
474MODULE_AUTHOR("Venu Byravarasu <vbyravarasu@nvidia.com>");
475MODULE_LICENSE("GPL");
476