|
@@ -12,6 +12,7 @@
|
|
|
*/
|
|
|
#include <linux/errno.h>
|
|
|
#include <linux/module.h>
|
|
|
+#include <linux/rtc.h>
|
|
|
#include <linux/sched.h>
|
|
|
#include <linux/kernel.h>
|
|
|
#include <linux/param.h>
|
|
@@ -248,14 +249,47 @@ void __init start_cpu_itimer(void)
|
|
|
per_cpu(cpu_data, cpu).it_value = next_tick;
|
|
|
}
|
|
|
|
|
|
+#if IS_ENABLED(CONFIG_RTC_DRV_GENERIC)
|
|
|
+static int rtc_generic_get_time(struct device *dev, struct rtc_time *tm)
|
|
|
+{
|
|
|
+ struct pdc_tod tod_data;
|
|
|
+
|
|
|
+ memset(tm, 0, sizeof(*tm));
|
|
|
+ if (pdc_tod_read(&tod_data) < 0)
|
|
|
+ return -EOPNOTSUPP;
|
|
|
+
|
|
|
+ /* we treat tod_sec as unsigned, so this can work until year 2106 */
|
|
|
+ rtc_time64_to_tm(tod_data.tod_sec, tm);
|
|
|
+ return rtc_valid_tm(tm);
|
|
|
+}
|
|
|
+
|
|
|
+static int rtc_generic_set_time(struct device *dev, struct rtc_time *tm)
|
|
|
+{
|
|
|
+ time64_t secs = rtc_tm_to_time64(tm);
|
|
|
+
|
|
|
+ if (pdc_tod_set(secs, 0) < 0)
|
|
|
+ return -EOPNOTSUPP;
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static const struct rtc_class_ops rtc_generic_ops = {
|
|
|
+ .read_time = rtc_generic_get_time,
|
|
|
+ .set_time = rtc_generic_set_time,
|
|
|
+};
|
|
|
+
|
|
|
static int __init rtc_init(void)
|
|
|
{
|
|
|
struct platform_device *pdev;
|
|
|
|
|
|
- pdev = platform_device_register_simple("rtc-generic", -1, NULL, 0);
|
|
|
+ pdev = platform_device_register_data(NULL, "rtc-generic", -1,
|
|
|
+ &rtc_generic_ops,
|
|
|
+ sizeof(rtc_generic_ops));
|
|
|
+
|
|
|
return PTR_ERR_OR_ZERO(pdev);
|
|
|
}
|
|
|
device_initcall(rtc_init);
|
|
|
+#endif
|
|
|
|
|
|
void read_persistent_clock(struct timespec *ts)
|
|
|
{
|