Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 | /* rtc-sun4v.c: Hypervisor based RTC for SUN4V systems. * * Author: David S. Miller * License: GPL * * Copyright (C) 2008 David S. Miller <davem@davemloft.net> */ #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt #include <linux/kernel.h> #include <linux/delay.h> #include <linux/init.h> #include <linux/rtc.h> #include <linux/platform_device.h> #include <asm/hypervisor.h> static unsigned long hypervisor_get_time(void) { unsigned long ret, time; int retries = 10000; retry: ret = sun4v_tod_get(&time); if (ret == HV_EOK) return time; if (ret == HV_EWOULDBLOCK) { if (--retries > 0) { udelay(100); goto retry; } pr_warn("tod_get() timed out.\n"); return 0; } pr_warn("tod_get() not supported.\n"); return 0; } static int sun4v_read_time(struct device *dev, struct rtc_time *tm) { rtc_time_to_tm(hypervisor_get_time(), tm); return 0; } static int hypervisor_set_time(unsigned long secs) { unsigned long ret; int retries = 10000; retry: ret = sun4v_tod_set(secs); if (ret == HV_EOK) return 0; if (ret == HV_EWOULDBLOCK) { if (--retries > 0) { udelay(100); goto retry; } pr_warn("tod_set() timed out.\n"); return -EAGAIN; } pr_warn("tod_set() not supported.\n"); return -EOPNOTSUPP; } static int sun4v_set_time(struct device *dev, struct rtc_time *tm) { unsigned long secs; int err; err = rtc_tm_to_time(tm, &secs); if (err) return err; return hypervisor_set_time(secs); } static const struct rtc_class_ops sun4v_rtc_ops = { .read_time = sun4v_read_time, .set_time = sun4v_set_time, }; static int __init sun4v_rtc_probe(struct platform_device *pdev) { struct rtc_device *rtc; rtc = devm_rtc_device_register(&pdev->dev, "sun4v", &sun4v_rtc_ops, THIS_MODULE); if (IS_ERR(rtc)) return PTR_ERR(rtc); platform_set_drvdata(pdev, rtc); return 0; } static struct platform_driver sun4v_rtc_driver = { .driver = { .name = "rtc-sun4v", }, }; builtin_platform_driver_probe(sun4v_rtc_driver, sun4v_rtc_probe); |