drivers/rtc/rtc-meson-vrtc.c

   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
  14 struct meson_vrtc_data {
  15         void __iomem *io_alarm;
  16         struct rtc_device *rtc;
  17         unsigned long alarm_time;
  18         bool enabled;
  19 };
  20
  21 static int meson_vrtc_read_time(struct device *dev, struct rtc_time *tm)
  22 {
  23         struct timespec64 time;
  24
  25         dev_dbg(dev, "%s\n", __func__);
  26         ktime_get_raw_ts64(&time);
  27         rtc_time64_to_tm(time.tv_sec, tm);
  28
  29         return 0;
  30 }
  31
  32 static void meson_vrtc_set_wakeup_time(struct meson_vrtc_data *vrtc,
  33                                        unsigned long time)
  34 {
  35         writel_relaxed(time, vrtc->io_alarm);
  36 }
  37
  38 static int meson_vrtc_set_alarm(struct device *dev, struct rtc_wkalrm *alarm)
  39 {
  40         struct meson_vrtc_data *vrtc = dev_get_drvdata(dev);
  41
  42         dev_dbg(dev, "%s: alarm->enabled=%d\n", __func__, alarm->enabled);
  43         if (alarm->enabled)
  44                 vrtc->alarm_time = rtc_tm_to_time64(&alarm->time);
  45         else
  46                 vrtc->alarm_time = 0;
  47
  48         return 0;
  49 }
  50
  51 static int meson_vrtc_alarm_irq_enable(struct device *dev, unsigned int enabled)
  52 {
  53         struct meson_vrtc_data *vrtc = dev_get_drvdata(dev);
  54
  55         vrtc->enabled = enabled;
  56         return 0;
  57 }
  58
  59 static const struct rtc_class_ops meson_vrtc_ops = {
  60         .read_time = meson_vrtc_read_time,
  61         .set_alarm = meson_vrtc_set_alarm,
  62         .alarm_irq_enable = meson_vrtc_alarm_irq_enable,
  63 };
  64
  65 static int meson_vrtc_probe(struct platform_device *pdev)
  66 {
  67         struct meson_vrtc_data *vrtc;
  68         int ret;
  69
  70         vrtc = devm_kzalloc(&pdev->dev, sizeof(*vrtc), GFP_KERNEL);
  71         if (!vrtc)
  72                 return -ENOMEM;
  73
  74         vrtc->io_alarm = devm_platform_ioremap_resource(pdev, 0);
  75         if (IS_ERR(vrtc->io_alarm))
  76                 return PTR_ERR(vrtc->io_alarm);
  77
  78         device_init_wakeup(&pdev->dev, 1);
  79
  80         platform_set_drvdata(pdev, vrtc);
  81
  82         vrtc->rtc = devm_rtc_allocate_device(&pdev->dev);
  83         if (IS_ERR(vrtc->rtc))
  84                 return PTR_ERR(vrtc->rtc);
  85
  86         vrtc->rtc->ops = &meson_vrtc_ops;
  87         ret = rtc_register_device(vrtc->rtc);
  88         if (ret)
  89                 return ret;
  90
  91         return 0;
  92 }
  93
  94 #ifdef CONFIG_PM_SLEEP
  95 static int meson_vrtc_suspend(struct device *dev)
  96 {
  97         struct meson_vrtc_data *vrtc = dev_get_drvdata(dev);
  98
  99         dev_dbg(dev, "%s\n", __func__);
 100         if (vrtc->alarm_time) {
 101                 unsigned long local_time;
 102                 long alarm_secs;
 103                 struct timespec64 time;
 104
 105                 ktime_get_raw_ts64(&time);
 106                 local_time = time.tv_sec;
 107
 108                 dev_dbg(dev, "alarm_time = %lus, local_time=%lus\n",
 109                         vrtc->alarm_time, local_time);
 110                 alarm_secs = vrtc->alarm_time - local_time;
 111                 if (alarm_secs > 0) {
 112                         meson_vrtc_set_wakeup_time(vrtc, alarm_secs);
 113                         dev_dbg(dev, "system will wakeup in %lds.\n",
 114                                 alarm_secs);
 115                 } else {
 116                         dev_err(dev, "alarm time already passed: %lds.\n",
 117                                 alarm_secs);
 118                 }
 119         }
 120
 121         return 0;
 122 }
 123
 124 static int meson_vrtc_resume(struct device *dev)
 125 {
 126         struct meson_vrtc_data *vrtc = dev_get_drvdata(dev);
 127
 128         dev_dbg(dev, "%s\n", __func__);
 129
 130         vrtc->alarm_time = 0;
 131         meson_vrtc_set_wakeup_time(vrtc, 0);
 132         return 0;
 133 }
 134 #endif
 135 static SIMPLE_DEV_PM_OPS(meson_vrtc_pm_ops,
 136                          meson_vrtc_suspend, meson_vrtc_resume);
 137
 138 static const struct of_device_id meson_vrtc_dt_match[] = {
 139         { .compatible = "amlogic,meson-vrtc"},
 140         {},
 141 };
 142 MODULE_DEVICE_TABLE(of, meson_vrtc_dt_match);
 143
 144 static struct platform_driver meson_vrtc_driver = {
 145         .probe = meson_vrtc_probe,
 146         .driver = {
 147                 .name = "meson-vrtc",
 148                 .of_match_table = meson_vrtc_dt_match,
 149                 .pm = &meson_vrtc_pm_ops,
 150         },
 151 };
 152
 153 module_platform_driver(meson_vrtc_driver);
 154
 155 MODULE_DESCRIPTION("Amlogic Virtual Wakeup RTC Timer driver");
 156 MODULE_LICENSE("GPL");