at master 3.5 kB view raw
1// SPDX-License-Identifier: GPL-2.0 2/* 3 * Copyright (C) 2019 BayLibre, SAS 4 * Author: Neil Armstrong <narmstrong@baylibre.com> 5 * Copyright (C) 2015 Amlogic, Inc. All rights reserved. 6 */ 7#include <linux/module.h> 8#include <linux/platform_device.h> 9#include <linux/rtc.h> 10#include <linux/io.h> 11#include <linux/of.h> 12#include <linux/time64.h> 13 14struct meson_vrtc_data { 15 void __iomem *io_alarm; 16 unsigned long alarm_time; 17 bool enabled; 18}; 19 20static int meson_vrtc_read_time(struct device *dev, struct rtc_time *tm) 21{ 22 struct timespec64 time; 23 24 dev_dbg(dev, "%s\n", __func__); 25 ktime_get_real_ts64(&time); 26 rtc_time64_to_tm(time.tv_sec, tm); 27 28 return 0; 29} 30 31static void meson_vrtc_set_wakeup_time(struct meson_vrtc_data *vrtc, 32 unsigned long time) 33{ 34 writel_relaxed(time, vrtc->io_alarm); 35} 36 37static int meson_vrtc_set_alarm(struct device *dev, struct rtc_wkalrm *alarm) 38{ 39 struct meson_vrtc_data *vrtc = dev_get_drvdata(dev); 40 41 dev_dbg(dev, "%s: alarm->enabled=%d\n", __func__, alarm->enabled); 42 if (alarm->enabled) 43 vrtc->alarm_time = rtc_tm_to_time64(&alarm->time); 44 else 45 vrtc->alarm_time = 0; 46 47 return 0; 48} 49 50static int meson_vrtc_alarm_irq_enable(struct device *dev, unsigned int enabled) 51{ 52 struct meson_vrtc_data *vrtc = dev_get_drvdata(dev); 53 54 vrtc->enabled = enabled; 55 return 0; 56} 57 58static const struct rtc_class_ops meson_vrtc_ops = { 59 .read_time = meson_vrtc_read_time, 60 .set_alarm = meson_vrtc_set_alarm, 61 .alarm_irq_enable = meson_vrtc_alarm_irq_enable, 62}; 63 64static int meson_vrtc_probe(struct platform_device *pdev) 65{ 66 struct meson_vrtc_data *vrtc; 67 struct rtc_device *rtc; 68 69 vrtc = devm_kzalloc(&pdev->dev, sizeof(*vrtc), GFP_KERNEL); 70 if (!vrtc) 71 return -ENOMEM; 72 73 vrtc->io_alarm = devm_platform_ioremap_resource(pdev, 0); 74 if (IS_ERR(vrtc->io_alarm)) 75 return PTR_ERR(vrtc->io_alarm); 76 77 device_init_wakeup(&pdev->dev, true); 78 79 platform_set_drvdata(pdev, vrtc); 80 81 rtc = devm_rtc_allocate_device(&pdev->dev); 82 if (IS_ERR(rtc)) 83 return PTR_ERR(rtc); 84 85 rtc->ops = &meson_vrtc_ops; 86 return devm_rtc_register_device(rtc); 87} 88 89static int __maybe_unused meson_vrtc_suspend(struct device *dev) 90{ 91 struct meson_vrtc_data *vrtc = dev_get_drvdata(dev); 92 93 dev_dbg(dev, "%s\n", __func__); 94 if (vrtc->alarm_time) { 95 unsigned long local_time; 96 long alarm_secs; 97 struct timespec64 time; 98 99 ktime_get_real_ts64(&time); 100 local_time = time.tv_sec; 101 102 dev_dbg(dev, "alarm_time = %lus, local_time=%lus\n", 103 vrtc->alarm_time, local_time); 104 alarm_secs = vrtc->alarm_time - local_time; 105 if (alarm_secs > 0) { 106 meson_vrtc_set_wakeup_time(vrtc, alarm_secs); 107 dev_dbg(dev, "system will wakeup in %lds.\n", 108 alarm_secs); 109 } else { 110 dev_err(dev, "alarm time already passed: %lds.\n", 111 alarm_secs); 112 } 113 } 114 115 return 0; 116} 117 118static int __maybe_unused meson_vrtc_resume(struct device *dev) 119{ 120 struct meson_vrtc_data *vrtc = dev_get_drvdata(dev); 121 122 dev_dbg(dev, "%s\n", __func__); 123 124 vrtc->alarm_time = 0; 125 meson_vrtc_set_wakeup_time(vrtc, 0); 126 return 0; 127} 128 129static SIMPLE_DEV_PM_OPS(meson_vrtc_pm_ops, 130 meson_vrtc_suspend, meson_vrtc_resume); 131 132static const struct of_device_id meson_vrtc_dt_match[] = { 133 { .compatible = "amlogic,meson-vrtc"}, 134 {}, 135}; 136MODULE_DEVICE_TABLE(of, meson_vrtc_dt_match); 137 138static struct platform_driver meson_vrtc_driver = { 139 .probe = meson_vrtc_probe, 140 .driver = { 141 .name = "meson-vrtc", 142 .of_match_table = meson_vrtc_dt_match, 143 .pm = &meson_vrtc_pm_ops, 144 }, 145}; 146 147module_platform_driver(meson_vrtc_driver); 148 149MODULE_DESCRIPTION("Amlogic Virtual Wakeup RTC Timer driver"); 150MODULE_LICENSE("GPL");