|
@@ -0,0 +1,104 @@
|
|
|
+/*
|
|
|
+ * PS3 RTC Driver
|
|
|
+ *
|
|
|
+ * Copyright 2009 Sony Corporation
|
|
|
+ *
|
|
|
+ * This program is free software; you can redistribute it and/or modify
|
|
|
+ * it under the terms of the GNU General Public License as published by
|
|
|
+ * the Free Software Foundation; version 2 of the License.
|
|
|
+ *
|
|
|
+ * This program is distributed in the hope that it will be useful,
|
|
|
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
+ * GNU General Public License for more details.
|
|
|
+ *
|
|
|
+ * You should have received a copy of the GNU General Public License
|
|
|
+ * along with this program.
|
|
|
+ * If not, see <http://www.gnu.org/licenses/>.
|
|
|
+ */
|
|
|
+
|
|
|
+#include <linux/kernel.h>
|
|
|
+#include <linux/module.h>
|
|
|
+#include <linux/platform_device.h>
|
|
|
+#include <linux/rtc.h>
|
|
|
+
|
|
|
+#include <asm/lv1call.h>
|
|
|
+#include <asm/ps3.h>
|
|
|
+
|
|
|
+
|
|
|
+static u64 read_rtc(void)
|
|
|
+{
|
|
|
+ int result;
|
|
|
+ u64 rtc_val;
|
|
|
+ u64 tb_val;
|
|
|
+
|
|
|
+ result = lv1_get_rtc(&rtc_val, &tb_val);
|
|
|
+ BUG_ON(result);
|
|
|
+
|
|
|
+ return rtc_val;
|
|
|
+}
|
|
|
+
|
|
|
+static int ps3_get_time(struct device *dev, struct rtc_time *tm)
|
|
|
+{
|
|
|
+ rtc_time_to_tm(read_rtc() + ps3_os_area_get_rtc_diff(), tm);
|
|
|
+ return rtc_valid_tm(tm);
|
|
|
+}
|
|
|
+
|
|
|
+static int ps3_set_time(struct device *dev, struct rtc_time *tm)
|
|
|
+{
|
|
|
+ unsigned long now;
|
|
|
+
|
|
|
+ rtc_tm_to_time(tm, &now);
|
|
|
+ ps3_os_area_set_rtc_diff(now - read_rtc());
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static const struct rtc_class_ops ps3_rtc_ops = {
|
|
|
+ .read_time = ps3_get_time,
|
|
|
+ .set_time = ps3_set_time,
|
|
|
+};
|
|
|
+
|
|
|
+static int __init ps3_rtc_probe(struct platform_device *dev)
|
|
|
+{
|
|
|
+ struct rtc_device *rtc;
|
|
|
+
|
|
|
+ rtc = rtc_device_register("rtc-ps3", &dev->dev, &ps3_rtc_ops,
|
|
|
+ THIS_MODULE);
|
|
|
+ if (IS_ERR(rtc))
|
|
|
+ return PTR_ERR(rtc);
|
|
|
+
|
|
|
+ platform_set_drvdata(dev, rtc);
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static int __exit ps3_rtc_remove(struct platform_device *dev)
|
|
|
+{
|
|
|
+ rtc_device_unregister(platform_get_drvdata(dev));
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static struct platform_driver ps3_rtc_driver = {
|
|
|
+ .driver = {
|
|
|
+ .name = "rtc-ps3",
|
|
|
+ .owner = THIS_MODULE,
|
|
|
+ },
|
|
|
+ .remove = __exit_p(ps3_rtc_remove),
|
|
|
+};
|
|
|
+
|
|
|
+static int __init ps3_rtc_init(void)
|
|
|
+{
|
|
|
+ return platform_driver_probe(&ps3_rtc_driver, ps3_rtc_probe);
|
|
|
+}
|
|
|
+
|
|
|
+static void __exit ps3_rtc_fini(void)
|
|
|
+{
|
|
|
+ platform_driver_unregister(&ps3_rtc_driver);
|
|
|
+}
|
|
|
+
|
|
|
+module_init(ps3_rtc_init);
|
|
|
+module_exit(ps3_rtc_fini);
|
|
|
+
|
|
|
+MODULE_AUTHOR("Sony Corporation");
|
|
|
+MODULE_LICENSE("GPL");
|
|
|
+MODULE_DESCRIPTION("ps3 RTC driver");
|
|
|
+MODULE_ALIAS("platform:rtc-ps3");
|