|
@@ -0,0 +1,70 @@
|
|
|
+/*
|
|
|
+ * Common code to keep time when machine suspends.
|
|
|
+ *
|
|
|
+ * Copyright 2007 Johannes Berg <johannes@sipsolutions.net>
|
|
|
+ *
|
|
|
+ * GPLv2
|
|
|
+ */
|
|
|
+
|
|
|
+#include <linux/time.h>
|
|
|
+#include <asm/rtc.h>
|
|
|
+
|
|
|
+static unsigned long suspend_rtc_time;
|
|
|
+
|
|
|
+/*
|
|
|
+ * Reset the time after a sleep.
|
|
|
+ */
|
|
|
+static int timer_resume(struct sys_device *dev)
|
|
|
+{
|
|
|
+ struct timeval tv;
|
|
|
+ struct timespec ts;
|
|
|
+ struct rtc_time cur_rtc_tm;
|
|
|
+ unsigned long cur_rtc_time, diff;
|
|
|
+
|
|
|
+ /* get current RTC time and convert to seconds */
|
|
|
+ get_rtc_time(&cur_rtc_tm);
|
|
|
+ rtc_tm_to_time(&cur_rtc_tm, &cur_rtc_time);
|
|
|
+
|
|
|
+ diff = cur_rtc_time - suspend_rtc_time;
|
|
|
+
|
|
|
+ /* adjust time of day by seconds that elapsed while
|
|
|
+ * we were suspended */
|
|
|
+ do_gettimeofday(&tv);
|
|
|
+ ts.tv_sec = tv.tv_sec + diff;
|
|
|
+ ts.tv_nsec = tv.tv_usec * NSEC_PER_USEC;
|
|
|
+ do_settimeofday(&ts);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static int timer_suspend(struct sys_device *dev, pm_message_t state)
|
|
|
+{
|
|
|
+ struct rtc_time suspend_rtc_tm;
|
|
|
+ WARN_ON(!ppc_md.get_rtc_time);
|
|
|
+
|
|
|
+ get_rtc_time(&suspend_rtc_tm);
|
|
|
+ rtc_tm_to_time(&suspend_rtc_tm, &suspend_rtc_time);
|
|
|
+
|
|
|
+ return 0;
|
|
|
+}
|
|
|
+
|
|
|
+static struct sysdev_class timer_sysclass = {
|
|
|
+ .resume = timer_resume,
|
|
|
+ .suspend = timer_suspend,
|
|
|
+ set_kset_name("timer"),
|
|
|
+};
|
|
|
+
|
|
|
+static struct sys_device device_timer = {
|
|
|
+ .id = 0,
|
|
|
+ .cls = &timer_sysclass,
|
|
|
+};
|
|
|
+
|
|
|
+static int time_init_device(void)
|
|
|
+{
|
|
|
+ int error = sysdev_class_register(&timer_sysclass);
|
|
|
+ if (!error)
|
|
|
+ error = sysdev_register(&device_timer);
|
|
|
+ return error;
|
|
|
+}
|
|
|
+
|
|
|
+device_initcall(time_init_device);
|