1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * An RTC test device/driver 4 * Copyright (C) 2005 Tower Technologies 5 * Author: Alessandro Zummo <a.zummo@towertech.it> 6 */ 7 8 #include <linux/module.h> 9 #include <linux/err.h> 10 #include <linux/rtc.h> 11 #include <linux/platform_device.h> 12 13 #define MAX_RTC_TEST 3 14 15 struct rtc_test_data { 16 struct rtc_device *rtc; 17 time64_t offset; 18 struct timer_list alarm; 19 bool alarm_en; 20 }; 21 22 static struct platform_device *pdev[MAX_RTC_TEST]; 23 24 static int test_rtc_read_alarm(struct device *dev, struct rtc_wkalrm *alrm) 25 { 26 struct rtc_test_data *rtd = dev_get_drvdata(dev); 27 time64_t alarm; 28 29 alarm = (rtd->alarm.expires - jiffies) / HZ; 30 alarm += ktime_get_real_seconds() + rtd->offset; 31 32 rtc_time64_to_tm(alarm, &alrm->time); 33 alrm->enabled = rtd->alarm_en; 34 35 return 0; 36 } 37 38 static int test_rtc_set_alarm(struct device *dev, struct rtc_wkalrm *alrm) 39 { 40 struct rtc_test_data *rtd = dev_get_drvdata(dev); 41 ktime_t timeout; 42 u64 expires; 43 44 timeout = rtc_tm_to_time64(&alrm->time) - ktime_get_real_seconds(); 45 timeout -= rtd->offset; 46 47 del_timer(&rtd->alarm); 48 49 expires = jiffies + timeout * HZ; 50 if (expires > U32_MAX) 51 expires = U32_MAX; 52 53 pr_err("ABE: %s +%d %s\n", __FILE__, __LINE__, __func__); 54 rtd->alarm.expires = expires; 55 56 if (alrm->enabled) 57 add_timer(&rtd->alarm); 58 59 rtd->alarm_en = alrm->enabled; 60 61 return 0; 62 } 63 64 static int test_rtc_read_time(struct device *dev, struct rtc_time *tm) 65 { 66 struct rtc_test_data *rtd = dev_get_drvdata(dev); 67 68 rtc_time64_to_tm(ktime_get_real_seconds() + rtd->offset, tm); 69 70 return 0; 71 } 72 73 static int test_rtc_set_time(struct device *dev, struct rtc_time *tm) 74 { 75 struct rtc_test_data *rtd = dev_get_drvdata(dev); 76 77 rtd->offset = rtc_tm_to_time64(tm) - ktime_get_real_seconds(); 78 79 return 0; 80 } 81 82 static int test_rtc_alarm_irq_enable(struct device *dev, unsigned int enable) 83 { 84 struct rtc_test_data *rtd = dev_get_drvdata(dev); 85 86 rtd->alarm_en = enable; 87 if (enable) 88 add_timer(&rtd->alarm); 89 else 90 del_timer(&rtd->alarm); 91 92 return 0; 93 } 94 95 static const struct rtc_class_ops test_rtc_ops_noalm = { 96 .read_time = test_rtc_read_time, 97 .set_time = test_rtc_set_time, 98 .alarm_irq_enable = test_rtc_alarm_irq_enable, 99 }; 100 101 static const struct rtc_class_ops test_rtc_ops = { 102 .read_time = test_rtc_read_time, 103 .set_time = test_rtc_set_time, 104 .read_alarm = test_rtc_read_alarm, 105 .set_alarm = test_rtc_set_alarm, 106 .alarm_irq_enable = test_rtc_alarm_irq_enable, 107 }; 108 109 static void test_rtc_alarm_handler(struct timer_list *t) 110 { 111 struct rtc_test_data *rtd = from_timer(rtd, t, alarm); 112 113 rtc_update_irq(rtd->rtc, 1, RTC_AF | RTC_IRQF); 114 } 115 116 static int test_probe(struct platform_device *plat_dev) 117 { 118 struct rtc_test_data *rtd; 119 120 rtd = devm_kzalloc(&plat_dev->dev, sizeof(*rtd), GFP_KERNEL); 121 if (!rtd) 122 return -ENOMEM; 123 124 platform_set_drvdata(plat_dev, rtd); 125 126 rtd->rtc = devm_rtc_allocate_device(&plat_dev->dev); 127 if (IS_ERR(rtd->rtc)) 128 return PTR_ERR(rtd->rtc); 129 130 switch (plat_dev->id) { 131 case 0: 132 rtd->rtc->ops = &test_rtc_ops_noalm; 133 break; 134 default: 135 rtd->rtc->ops = &test_rtc_ops; 136 } 137 138 timer_setup(&rtd->alarm, test_rtc_alarm_handler, 0); 139 rtd->alarm.expires = 0; 140 141 return rtc_register_device(rtd->rtc); 142 } 143 144 static struct platform_driver test_driver = { 145 .probe = test_probe, 146 .driver = { 147 .name = "rtc-test", 148 }, 149 }; 150 151 static int __init test_init(void) 152 { 153 int i, err; 154 155 err = platform_driver_register(&test_driver); 156 if (err) 157 return err; 158 159 err = -ENOMEM; 160 for (i = 0; i < MAX_RTC_TEST; i++) { 161 pdev[i] = platform_device_alloc("rtc-test", i); 162 if (!pdev[i]) 163 goto exit_free_mem; 164 } 165 166 for (i = 0; i < MAX_RTC_TEST; i++) { 167 err = platform_device_add(pdev[i]); 168 if (err) 169 goto exit_device_del; 170 } 171 172 return 0; 173 174 exit_device_del: 175 for (; i > 0; i--) 176 platform_device_del(pdev[i - 1]); 177 178 exit_free_mem: 179 for (i = 0; i < MAX_RTC_TEST; i++) 180 platform_device_put(pdev[i]); 181 182 platform_driver_unregister(&test_driver); 183 return err; 184 } 185 186 static void __exit test_exit(void) 187 { 188 int i; 189 190 for (i = 0; i < MAX_RTC_TEST; i++) 191 platform_device_unregister(pdev[i]); 192 193 platform_driver_unregister(&test_driver); 194 } 195 196 MODULE_AUTHOR("Alessandro Zummo <a.zummo@towertech.it>"); 197 MODULE_DESCRIPTION("RTC test driver/device"); 198 MODULE_LICENSE("GPL v2"); 199 200 module_init(test_init); 201 module_exit(test_exit); 202