2 * Copyright (C) 2011-2012 Freescale Semiconductor, Inc.
4 * The code contained herein is licensed under the GNU General Public
5 * License. You may obtain a copy of the GNU General Public License
6 * Version 2 or later at the following locations:
8 * http://www.opensource.org/licenses/gpl-license.html
9 * http://www.gnu.org/copyleft/gpl.html
12 #include <linux/init.h>
14 #include <linux/kernel.h>
15 #include <linux/module.h>
17 #include <linux/of_device.h>
18 #include <linux/platform_device.h>
19 #include <linux/rtc.h>
20 #include <linux/clk.h>
21 #include <linux/mfd/syscon.h>
22 #include <linux/regmap.h>
24 #define SNVS_LPREGISTER_OFFSET 0x34
26 /* These register offsets are relative to LP (Low Power) range */
27 #define SNVS_LPCR 0x04
28 #define SNVS_LPSR 0x18
29 #define SNVS_LPSRTCMR 0x1c
30 #define SNVS_LPSRTCLR 0x20
31 #define SNVS_LPTAR 0x24
32 #define SNVS_LPPGDR 0x30
34 #define SNVS_LPCR_SRTC_ENV (1 << 0)
35 #define SNVS_LPCR_LPTA_EN (1 << 1)
36 #define SNVS_LPCR_LPWUI_EN (1 << 3)
37 #define SNVS_LPSR_LPTA (1 << 0)
39 #define SNVS_LPPGDR_INIT 0x41736166
40 #define CNTR_TO_SECS_SH 15
42 struct snvs_rtc_data
{
43 struct rtc_device
*rtc
;
44 struct regmap
*regmap
;
50 static u32
rtc_read_lp_counter(struct snvs_rtc_data
*data
)
56 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPSRTCMR
, &val
);
59 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPSRTCLR
, &val
);
62 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPSRTCMR
, &val
);
65 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPSRTCLR
, &val
);
67 } while (read1
!= read2
);
69 /* Convert 47-bit counter to 32-bit raw second count */
70 return (u32
) (read1
>> CNTR_TO_SECS_SH
);
73 static void rtc_write_sync_lp(struct snvs_rtc_data
*data
)
75 u32 count1
, count2
, count3
;
78 /* Wait for 3 CKIL cycles */
79 for (i
= 0; i
< 3; i
++) {
81 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPSRTCLR
, &count1
);
82 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPSRTCLR
, &count2
);
83 } while (count1
!= count2
);
85 /* Now wait until counter value changes */
88 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPSRTCLR
, &count2
);
89 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPSRTCLR
, &count3
);
90 } while (count2
!= count3
);
91 } while (count3
== count1
);
95 static int snvs_rtc_enable(struct snvs_rtc_data
*data
, bool enable
)
100 regmap_update_bits(data
->regmap
, data
->offset
+ SNVS_LPCR
, SNVS_LPCR_SRTC_ENV
,
101 enable
? SNVS_LPCR_SRTC_ENV
: 0);
104 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPCR
, &lpcr
);
107 if (lpcr
& SNVS_LPCR_SRTC_ENV
)
110 if (!(lpcr
& SNVS_LPCR_SRTC_ENV
))
121 static int snvs_rtc_read_time(struct device
*dev
, struct rtc_time
*tm
)
123 struct snvs_rtc_data
*data
= dev_get_drvdata(dev
);
124 unsigned long time
= rtc_read_lp_counter(data
);
126 rtc_time_to_tm(time
, tm
);
131 static int snvs_rtc_set_time(struct device
*dev
, struct rtc_time
*tm
)
133 struct snvs_rtc_data
*data
= dev_get_drvdata(dev
);
136 rtc_tm_to_time(tm
, &time
);
138 /* Disable RTC first */
139 snvs_rtc_enable(data
, false);
141 /* Write 32-bit time to 47-bit timer, leaving 15 LSBs blank */
142 regmap_write(data
->regmap
, data
->offset
+ SNVS_LPSRTCLR
, time
<< CNTR_TO_SECS_SH
);
143 regmap_write(data
->regmap
, data
->offset
+ SNVS_LPSRTCMR
, time
>> (32 - CNTR_TO_SECS_SH
));
145 /* Enable RTC again */
146 snvs_rtc_enable(data
, true);
151 static int snvs_rtc_read_alarm(struct device
*dev
, struct rtc_wkalrm
*alrm
)
153 struct snvs_rtc_data
*data
= dev_get_drvdata(dev
);
156 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPTAR
, &lptar
);
157 rtc_time_to_tm(lptar
, &alrm
->time
);
159 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPSR
, &lpsr
);
160 alrm
->pending
= (lpsr
& SNVS_LPSR_LPTA
) ? 1 : 0;
165 static int snvs_rtc_alarm_irq_enable(struct device
*dev
, unsigned int enable
)
167 struct snvs_rtc_data
*data
= dev_get_drvdata(dev
);
169 regmap_update_bits(data
->regmap
, data
->offset
+ SNVS_LPCR
,
170 (SNVS_LPCR_LPTA_EN
| SNVS_LPCR_LPWUI_EN
),
171 enable
? (SNVS_LPCR_LPTA_EN
| SNVS_LPCR_LPWUI_EN
) : 0);
173 rtc_write_sync_lp(data
);
178 static int snvs_rtc_set_alarm(struct device
*dev
, struct rtc_wkalrm
*alrm
)
180 struct snvs_rtc_data
*data
= dev_get_drvdata(dev
);
181 struct rtc_time
*alrm_tm
= &alrm
->time
;
184 rtc_tm_to_time(alrm_tm
, &time
);
186 regmap_update_bits(data
->regmap
, data
->offset
+ SNVS_LPCR
, SNVS_LPCR_LPTA_EN
, 0);
187 regmap_write(data
->regmap
, data
->offset
+ SNVS_LPTAR
, time
);
189 /* Clear alarm interrupt status bit */
190 regmap_write(data
->regmap
, data
->offset
+ SNVS_LPSR
, SNVS_LPSR_LPTA
);
192 return snvs_rtc_alarm_irq_enable(dev
, alrm
->enabled
);
195 static const struct rtc_class_ops snvs_rtc_ops
= {
196 .read_time
= snvs_rtc_read_time
,
197 .set_time
= snvs_rtc_set_time
,
198 .read_alarm
= snvs_rtc_read_alarm
,
199 .set_alarm
= snvs_rtc_set_alarm
,
200 .alarm_irq_enable
= snvs_rtc_alarm_irq_enable
,
203 static irqreturn_t
snvs_rtc_irq_handler(int irq
, void *dev_id
)
205 struct device
*dev
= dev_id
;
206 struct snvs_rtc_data
*data
= dev_get_drvdata(dev
);
210 regmap_read(data
->regmap
, data
->offset
+ SNVS_LPSR
, &lpsr
);
212 if (lpsr
& SNVS_LPSR_LPTA
) {
213 events
|= (RTC_AF
| RTC_IRQF
);
215 /* RTC alarm should be one-shot */
216 snvs_rtc_alarm_irq_enable(dev
, 0);
218 rtc_update_irq(data
->rtc
, 1, events
);
221 /* clear interrupt status */
222 regmap_write(data
->regmap
, data
->offset
+ SNVS_LPSR
, lpsr
);
224 return events
? IRQ_HANDLED
: IRQ_NONE
;
227 static const struct regmap_config snvs_rtc_config
= {
233 static int snvs_rtc_probe(struct platform_device
*pdev
)
235 struct snvs_rtc_data
*data
;
236 struct resource
*res
;
240 data
= devm_kzalloc(&pdev
->dev
, sizeof(*data
), GFP_KERNEL
);
244 data
->regmap
= syscon_regmap_lookup_by_phandle(pdev
->dev
.of_node
, "regmap");
246 if (IS_ERR(data
->regmap
)) {
247 dev_warn(&pdev
->dev
, "snvs rtc: you use old dts file, please update it\n");
248 res
= platform_get_resource(pdev
, IORESOURCE_MEM
, 0);
250 mmio
= devm_ioremap_resource(&pdev
->dev
, res
);
252 return PTR_ERR(mmio
);
254 data
->regmap
= devm_regmap_init_mmio(&pdev
->dev
, mmio
, &snvs_rtc_config
);
256 data
->offset
= SNVS_LPREGISTER_OFFSET
;
257 of_property_read_u32(pdev
->dev
.of_node
, "offset", &data
->offset
);
261 dev_err(&pdev
->dev
, "Can't find snvs syscon\n");
265 data
->irq
= platform_get_irq(pdev
, 0);
269 data
->clk
= devm_clk_get(&pdev
->dev
, "snvs-rtc");
270 if (IS_ERR(data
->clk
)) {
273 ret
= clk_prepare_enable(data
->clk
);
276 "Could not prepare or enable the snvs clock\n");
281 platform_set_drvdata(pdev
, data
);
283 /* Initialize glitch detect */
284 regmap_write(data
->regmap
, data
->offset
+ SNVS_LPPGDR
, SNVS_LPPGDR_INIT
);
286 /* Clear interrupt status */
287 regmap_write(data
->regmap
, data
->offset
+ SNVS_LPSR
, 0xffffffff);
290 snvs_rtc_enable(data
, true);
292 device_init_wakeup(&pdev
->dev
, true);
294 ret
= devm_request_irq(&pdev
->dev
, data
->irq
, snvs_rtc_irq_handler
,
295 IRQF_SHARED
, "rtc alarm", &pdev
->dev
);
297 dev_err(&pdev
->dev
, "failed to request irq %d: %d\n",
299 goto error_rtc_device_register
;
302 data
->rtc
= devm_rtc_device_register(&pdev
->dev
, pdev
->name
,
303 &snvs_rtc_ops
, THIS_MODULE
);
304 if (IS_ERR(data
->rtc
)) {
305 ret
= PTR_ERR(data
->rtc
);
306 dev_err(&pdev
->dev
, "failed to register rtc: %d\n", ret
);
307 goto error_rtc_device_register
;
312 error_rtc_device_register
:
314 clk_disable_unprepare(data
->clk
);
319 #ifdef CONFIG_PM_SLEEP
320 static int snvs_rtc_suspend(struct device
*dev
)
322 struct snvs_rtc_data
*data
= dev_get_drvdata(dev
);
324 if (device_may_wakeup(dev
))
325 enable_irq_wake(data
->irq
);
330 static int snvs_rtc_suspend_noirq(struct device
*dev
)
332 struct snvs_rtc_data
*data
= dev_get_drvdata(dev
);
335 clk_disable_unprepare(data
->clk
);
340 static int snvs_rtc_resume(struct device
*dev
)
342 struct snvs_rtc_data
*data
= dev_get_drvdata(dev
);
344 if (device_may_wakeup(dev
))
345 return disable_irq_wake(data
->irq
);
350 static int snvs_rtc_resume_noirq(struct device
*dev
)
352 struct snvs_rtc_data
*data
= dev_get_drvdata(dev
);
355 return clk_prepare_enable(data
->clk
);
360 static const struct dev_pm_ops snvs_rtc_pm_ops
= {
361 .suspend
= snvs_rtc_suspend
,
362 .suspend_noirq
= snvs_rtc_suspend_noirq
,
363 .resume
= snvs_rtc_resume
,
364 .resume_noirq
= snvs_rtc_resume_noirq
,
367 #define SNVS_RTC_PM_OPS (&snvs_rtc_pm_ops)
371 #define SNVS_RTC_PM_OPS NULL
375 static const struct of_device_id snvs_dt_ids
[] = {
376 { .compatible
= "fsl,sec-v4.0-mon-rtc-lp", },
379 MODULE_DEVICE_TABLE(of
, snvs_dt_ids
);
381 static struct platform_driver snvs_rtc_driver
= {
384 .pm
= SNVS_RTC_PM_OPS
,
385 .of_match_table
= snvs_dt_ids
,
387 .probe
= snvs_rtc_probe
,
389 module_platform_driver(snvs_rtc_driver
);
391 MODULE_AUTHOR("Freescale Semiconductor, Inc.");
392 MODULE_DESCRIPTION("Freescale SNVS RTC Driver");
393 MODULE_LICENSE("GPL");