1 // SPDX-License-Identifier: GPL-2.0+
3 // Copyright (C) 2011-2012 Freescale Semiconductor, Inc.
5 #include <linux/init.h>
7 #include <linux/kernel.h>
8 #include <linux/module.h>
10 #include <linux/platform_device.h>
11 #include <linux/pm_wakeirq.h>
12 #include <linux/rtc.h>
13 #include <linux/clk.h>
14 #include <linux/mfd/syscon.h>
15 #include <linux/regmap.h>
17 #define SNVS_LPREGISTER_OFFSET 0x34
19 /* These register offsets are relative to LP (Low Power) range */
20 #define SNVS_LPCR 0x04
21 #define SNVS_LPSR 0x18
22 #define SNVS_LPSRTCMR 0x1c
23 #define SNVS_LPSRTCLR 0x20
24 #define SNVS_LPTAR 0x24
25 #define SNVS_LPPGDR 0x30
27 #define SNVS_LPCR_SRTC_ENV (1 << 0)
28 #define SNVS_LPCR_LPTA_EN (1 << 1)
29 #define SNVS_LPCR_LPWUI_EN (1 << 3)
30 #define SNVS_LPSR_LPTA (1 << 0)
32 #define SNVS_LPPGDR_INIT 0x41736166
33 #define CNTR_TO_SECS_SH 15
35 /* The maximum RTC clock cycles that are allowed to pass between two
36 * consecutive clock counter register reads. If the values are corrupted a
37 * bigger difference is expected. The RTC frequency is 32kHz. With 320 cycles
38 * we end at 10ms which should be enough for most cases. If it once takes
39 * longer than expected we do a retry.
41 #define MAX_RTC_READ_DIFF_CYCLES 320
43 struct snvs_rtc_data
{
44 struct rtc_device
*rtc
;
45 struct regmap
*regmap
;
51 /* Read 64 bit timer register, which could be in inconsistent state */
52 static u64
rtc_read_lpsrt(struct snvs_rtc_data
*data
)
56 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPSRTCMR
, &msb
);
57 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPSRTCLR
, &lsb
);
58 return (u64
)msb
<< 32 | lsb
;
61 /* Read the secure real time counter, taking care to deal with the cases of the
62 * counter updating while being read.
64 static u32
rtc_read_lp_counter(struct snvs_rtc_data
*data
)
68 unsigned int timeout
= 100;
70 /* As expected, the registers might update between the read of the LSB
71 * reg and the MSB reg. It's also possible that one register might be
72 * in partially modified state as well.
74 read1
= rtc_read_lpsrt(data
);
77 read1
= rtc_read_lpsrt(data
);
79 } while (((diff
< 0) || (diff
> MAX_RTC_READ_DIFF_CYCLES
)) && --timeout
);
81 dev_err(&data
->rtc
->dev
, "Timeout trying to get valid LPSRT Counter read\n");
83 /* Convert 47-bit counter to 32-bit raw second count */
84 return (u32
) (read1
>> CNTR_TO_SECS_SH
);
87 /* Just read the lsb from the counter, dealing with inconsistent state */
88 static int rtc_read_lp_counter_lsb(struct snvs_rtc_data
*data
, u32
*lsb
)
92 unsigned int timeout
= 100;
94 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPSRTCLR
, &count1
);
97 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPSRTCLR
, &count1
);
98 diff
= count1
- count2
;
99 } while (((diff
< 0) || (diff
> MAX_RTC_READ_DIFF_CYCLES
)) && --timeout
);
101 dev_err(&data
->rtc
->dev
, "Timeout trying to get valid LPSRT Counter read\n");
109 static int rtc_write_sync_lp(struct snvs_rtc_data
*data
)
113 unsigned int timeout
= 1000;
116 ret
= rtc_read_lp_counter_lsb(data
, &count1
);
120 /* Wait for 3 CKIL cycles, about 61.0-91.5 µs */
122 ret
= rtc_read_lp_counter_lsb(data
, &count2
);
125 elapsed
= count2
- count1
; /* wrap around _is_ handled! */
126 } while (elapsed
< 3 && --timeout
);
128 dev_err(&data
->rtc
->dev
, "Timeout waiting for LPSRT Counter to change\n");
134 static int snvs_rtc_enable(struct snvs_rtc_data
*data
, bool enable
)
139 regmap_update_bits(data
->regmap
, data
->offset
+ SNVS_LPCR
, SNVS_LPCR_SRTC_ENV
,
140 enable
? SNVS_LPCR_SRTC_ENV
: 0);
143 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPCR
, &lpcr
);
146 if (lpcr
& SNVS_LPCR_SRTC_ENV
)
149 if (!(lpcr
& SNVS_LPCR_SRTC_ENV
))
160 static int snvs_rtc_read_time(struct device
*dev
, struct rtc_time
*tm
)
162 struct snvs_rtc_data
*data
= dev_get_drvdata(dev
);
166 ret
= clk_enable(data
->clk
);
170 time
= rtc_read_lp_counter(data
);
171 rtc_time64_to_tm(time
, tm
);
173 clk_disable(data
->clk
);
178 static int snvs_rtc_set_time(struct device
*dev
, struct rtc_time
*tm
)
180 struct snvs_rtc_data
*data
= dev_get_drvdata(dev
);
181 unsigned long time
= rtc_tm_to_time64(tm
);
184 ret
= clk_enable(data
->clk
);
188 /* Disable RTC first */
189 ret
= snvs_rtc_enable(data
, false);
193 /* Write 32-bit time to 47-bit timer, leaving 15 LSBs blank */
194 regmap_write(data
->regmap
, data
->offset
+ SNVS_LPSRTCLR
, time
<< CNTR_TO_SECS_SH
);
195 regmap_write(data
->regmap
, data
->offset
+ SNVS_LPSRTCMR
, time
>> (32 - CNTR_TO_SECS_SH
));
197 /* Enable RTC again */
198 ret
= snvs_rtc_enable(data
, true);
200 clk_disable(data
->clk
);
205 static int snvs_rtc_read_alarm(struct device
*dev
, struct rtc_wkalrm
*alrm
)
207 struct snvs_rtc_data
*data
= dev_get_drvdata(dev
);
211 ret
= clk_enable(data
->clk
);
215 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPTAR
, &lptar
);
216 rtc_time64_to_tm(lptar
, &alrm
->time
);
218 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPSR
, &lpsr
);
219 alrm
->pending
= (lpsr
& SNVS_LPSR_LPTA
) ? 1 : 0;
221 clk_disable(data
->clk
);
226 static int snvs_rtc_alarm_irq_enable(struct device
*dev
, unsigned int enable
)
228 struct snvs_rtc_data
*data
= dev_get_drvdata(dev
);
231 ret
= clk_enable(data
->clk
);
235 regmap_update_bits(data
->regmap
, data
->offset
+ SNVS_LPCR
,
236 (SNVS_LPCR_LPTA_EN
| SNVS_LPCR_LPWUI_EN
),
237 enable
? (SNVS_LPCR_LPTA_EN
| SNVS_LPCR_LPWUI_EN
) : 0);
239 ret
= rtc_write_sync_lp(data
);
241 clk_disable(data
->clk
);
246 static int snvs_rtc_set_alarm(struct device
*dev
, struct rtc_wkalrm
*alrm
)
248 struct snvs_rtc_data
*data
= dev_get_drvdata(dev
);
249 unsigned long time
= rtc_tm_to_time64(&alrm
->time
);
252 ret
= clk_enable(data
->clk
);
256 regmap_update_bits(data
->regmap
, data
->offset
+ SNVS_LPCR
, SNVS_LPCR_LPTA_EN
, 0);
257 ret
= rtc_write_sync_lp(data
);
260 regmap_write(data
->regmap
, data
->offset
+ SNVS_LPTAR
, time
);
262 /* Clear alarm interrupt status bit */
263 regmap_write(data
->regmap
, data
->offset
+ SNVS_LPSR
, SNVS_LPSR_LPTA
);
265 clk_disable(data
->clk
);
267 return snvs_rtc_alarm_irq_enable(dev
, alrm
->enabled
);
270 static const struct rtc_class_ops snvs_rtc_ops
= {
271 .read_time
= snvs_rtc_read_time
,
272 .set_time
= snvs_rtc_set_time
,
273 .read_alarm
= snvs_rtc_read_alarm
,
274 .set_alarm
= snvs_rtc_set_alarm
,
275 .alarm_irq_enable
= snvs_rtc_alarm_irq_enable
,
278 static irqreturn_t
snvs_rtc_irq_handler(int irq
, void *dev_id
)
280 struct device
*dev
= dev_id
;
281 struct snvs_rtc_data
*data
= dev_get_drvdata(dev
);
285 clk_enable(data
->clk
);
287 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPSR
, &lpsr
);
289 if (lpsr
& SNVS_LPSR_LPTA
) {
290 events
|= (RTC_AF
| RTC_IRQF
);
292 /* RTC alarm should be one-shot */
293 snvs_rtc_alarm_irq_enable(dev
, 0);
295 rtc_update_irq(data
->rtc
, 1, events
);
298 /* clear interrupt status */
299 regmap_write(data
->regmap
, data
->offset
+ SNVS_LPSR
, lpsr
);
301 clk_disable(data
->clk
);
303 return events
? IRQ_HANDLED
: IRQ_NONE
;
306 static const struct regmap_config snvs_rtc_config
= {
312 static void snvs_rtc_action(void *data
)
314 clk_disable_unprepare(data
);
317 static int snvs_rtc_probe(struct platform_device
*pdev
)
319 struct snvs_rtc_data
*data
;
323 data
= devm_kzalloc(&pdev
->dev
, sizeof(*data
), GFP_KERNEL
);
327 data
->rtc
= devm_rtc_allocate_device(&pdev
->dev
);
328 if (IS_ERR(data
->rtc
))
329 return PTR_ERR(data
->rtc
);
331 data
->regmap
= syscon_regmap_lookup_by_phandle(pdev
->dev
.of_node
, "regmap");
333 if (IS_ERR(data
->regmap
)) {
334 dev_warn(&pdev
->dev
, "snvs rtc: you use old dts file, please update it\n");
336 mmio
= devm_platform_ioremap_resource(pdev
, 0);
338 return PTR_ERR(mmio
);
340 data
->regmap
= devm_regmap_init_mmio(&pdev
->dev
, mmio
, &snvs_rtc_config
);
342 data
->offset
= SNVS_LPREGISTER_OFFSET
;
343 of_property_read_u32(pdev
->dev
.of_node
, "offset", &data
->offset
);
346 if (IS_ERR(data
->regmap
)) {
347 dev_err(&pdev
->dev
, "Can't find snvs syscon\n");
351 data
->irq
= platform_get_irq(pdev
, 0);
355 data
->clk
= devm_clk_get(&pdev
->dev
, "snvs-rtc");
356 if (IS_ERR(data
->clk
)) {
359 ret
= clk_prepare_enable(data
->clk
);
362 "Could not prepare or enable the snvs clock\n");
367 ret
= devm_add_action_or_reset(&pdev
->dev
, snvs_rtc_action
, data
->clk
);
371 platform_set_drvdata(pdev
, data
);
373 /* Initialize glitch detect */
374 regmap_write(data
->regmap
, data
->offset
+ SNVS_LPPGDR
, SNVS_LPPGDR_INIT
);
376 /* Clear interrupt status */
377 regmap_write(data
->regmap
, data
->offset
+ SNVS_LPSR
, 0xffffffff);
380 ret
= snvs_rtc_enable(data
, true);
382 dev_err(&pdev
->dev
, "failed to enable rtc %d\n", ret
);
386 device_init_wakeup(&pdev
->dev
, true);
387 ret
= dev_pm_set_wake_irq(&pdev
->dev
, data
->irq
);
389 dev_err(&pdev
->dev
, "failed to enable irq wake\n");
391 ret
= devm_request_irq(&pdev
->dev
, data
->irq
, snvs_rtc_irq_handler
,
392 IRQF_SHARED
, "rtc alarm", &pdev
->dev
);
394 dev_err(&pdev
->dev
, "failed to request irq %d: %d\n",
399 data
->rtc
->ops
= &snvs_rtc_ops
;
400 data
->rtc
->range_max
= U32_MAX
;
402 return devm_rtc_register_device(data
->rtc
);
405 static int __maybe_unused
snvs_rtc_suspend_noirq(struct device
*dev
)
407 struct snvs_rtc_data
*data
= dev_get_drvdata(dev
);
409 clk_disable(data
->clk
);
414 static int __maybe_unused
snvs_rtc_resume_noirq(struct device
*dev
)
416 struct snvs_rtc_data
*data
= dev_get_drvdata(dev
);
419 return clk_enable(data
->clk
);
424 static const struct dev_pm_ops snvs_rtc_pm_ops
= {
425 SET_NOIRQ_SYSTEM_SLEEP_PM_OPS(snvs_rtc_suspend_noirq
, snvs_rtc_resume_noirq
)
428 static const struct of_device_id snvs_dt_ids
[] = {
429 { .compatible
= "fsl,sec-v4.0-mon-rtc-lp", },
432 MODULE_DEVICE_TABLE(of
, snvs_dt_ids
);
434 static struct platform_driver snvs_rtc_driver
= {
437 .pm
= &snvs_rtc_pm_ops
,
438 .of_match_table
= snvs_dt_ids
,
440 .probe
= snvs_rtc_probe
,
442 module_platform_driver(snvs_rtc_driver
);
444 MODULE_AUTHOR("Freescale Semiconductor, Inc.");
445 MODULE_DESCRIPTION("Freescale SNVS RTC Driver");
446 MODULE_LICENSE("GPL");