rtc: test: emulate alarms using timers

Use timers to emulate alarms. Note that multiple alarms may happen if they
are set more than 15 days after the current RTC time.

Signed-off-by: Alexandre Belloni <alexandre.belloni@bootlin.com>

diff --git a/drivers/rtc/rtc-test.c b/drivers/rtc/rtc-test.c
index f50b3321314f30994e5efd0099ea19b9b08e7ee0..3aee7be3a58a5021161adb4b12e0984a6a54e341 100644 (file)
--- a/drivers/rtc/rtc-test.c
+++ b/drivers/rtc/rtc-test.c
@@ -18,19 +18,49 @@
 struct rtc_test_data {
        struct rtc_device *rtc;
        time64_t offset;
+       struct timer_list alarm;
+       bool alarm_en;
 };
 
 struct platform_device *pdev[MAX_RTC_TEST];
 
-static int test_rtc_read_alarm(struct device *dev,
-       struct rtc_wkalrm *alrm)
+static int test_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alrm)
 {
+       struct rtc_test_data *rtd = dev_get_drvdata(dev);
+       time64_t alarm;
+
+       alarm = (rtd->alarm.expires - jiffies) / HZ;
+       alarm += ktime_get_real_seconds() + rtd->offset;
+
+       rtc_time64_to_tm(alarm, &alrm->time);
+       alrm->enabled = rtd->alarm_en;
+
        return 0;
 }
 
-static int test_rtc_set_alarm(struct device *dev,
-       struct rtc_wkalrm *alrm)
+static int test_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alrm)
 {
+       struct rtc_test_data *rtd = dev_get_drvdata(dev);
+       ktime_t timeout;
+       u64 expires;
+
+       timeout = rtc_tm_to_time64(&alrm->time) - ktime_get_real_seconds();
+       timeout -= rtd->offset;
+
+       del_timer(&rtd->alarm);
+
+       expires = jiffies + timeout * HZ;
+       if (expires > U32_MAX)
+               expires = U32_MAX;
+
+       pr_err("ABE: %s +%d %s\n", __FILE__, __LINE__, __func__);
+       rtd->alarm.expires = expires;
+
+       if (alrm->enabled)
+               add_timer(&rtd->alarm);
+
+       rtd->alarm_en = alrm->enabled;
+
        return 0;
 }
 
@@ -54,6 +84,14 @@ static int test_rtc_set_mmss64(struct device *dev, time64_t secs)
 
 static int test_rtc_alarm_irq_enable(struct device *dev, unsigned int enable)
 {
+       struct rtc_test_data *rtd = dev_get_drvdata(dev);
+
+       rtd->alarm_en = enable;
+       if (enable)
+               add_timer(&rtd->alarm);
+       else
+               del_timer(&rtd->alarm);
+
        return 0;
 }
 
@@ -65,6 +103,13 @@ static const struct rtc_class_ops test_rtc_ops = {
        .alarm_irq_enable = test_rtc_alarm_irq_enable,
 };
 
+static void test_rtc_alarm_handler(struct timer_list *t)
+{
+       struct rtc_test_data *rtd = from_timer(rtd, t, alarm);
+
+       rtc_update_irq(rtd->rtc, 1, RTC_AF | RTC_IRQF);
+}
+
 static ssize_t test_irq_show(struct device *dev,
                                struct device_attribute *attr, char *buf)
 {
@@ -111,6 +156,9 @@ static int test_probe(struct platform_device *plat_dev)
        if (IS_ERR(rtd->rtc))
                return PTR_ERR(rtd->rtc);
 
+       timer_setup(&rtd->alarm, test_rtc_alarm_handler, 0);
+       rtd->alarm.expires = 0;
+
        return 0;
 }