@@ -12,4 +12,8 @@ void tst_wallclock_save(void);
void tst_wallclock_restore(void);
+void tst_rtc_clock_save(char *rtc_dev);
+
+void tst_rtc_clock_restore(char *rtc_dev);
+
#endif /* TST_WALLCLK_H__ */
@@ -11,11 +11,14 @@
#include "tst_test.h"
#include "tst_timer.h"
#include "tst_clocks.h"
+#include "tst_rtctime.h"
#include "tst_wallclock.h"
#include "lapi/posix_clocks.h"
static struct timespec real_begin, mono_begin;
+static struct rtc_time rtc_begin;
+
static int clock_saved;
void tst_wallclock_save(void)
@@ -58,3 +61,44 @@ void tst_wallclock_restore(void)
if (tst_clock_settime(CLOCK_REALTIME, &adjust))
tst_brk(TBROK | TERRNO, "tst_clock_settime() realtime failed");
}
+
+void tst_rtc_clock_save(char *rtc_dev)
+{
+ /* save initial monotonic time to restore it when needed */
+ if (tst_rtc_gettime(rtc_dev, &rtc_begin))
+ tst_brk(TBROK | TERRNO, "tst_rtc_gettime() realtime failed");
+
+ if (tst_clock_gettime(CLOCK_MONOTONIC_RAW, &mono_begin))
+ tst_brk(TBROK | TERRNO, "tst_clock_gettime() monotonic failed");
+
+ clock_saved = 1;
+}
+
+void tst_rtc_clock_restore(char *rtc_dev)
+{
+ static struct timespec mono_end, elapsed;
+ static struct timespec rtc_begin_tm, rtc_adjust;
+ static struct rtc_time rtc_restore;
+
+ if (!clock_saved)
+ return;
+
+ clock_saved = 0;
+
+ if (tst_clock_gettime(CLOCK_MONOTONIC_RAW, &mono_end))
+ tst_brk(TBROK | TERRNO, "tst_clock_gettime() monotonic failed");
+
+ elapsed = tst_timespec_diff(mono_end, mono_begin);
+
+ rtc_begin_tm.tv_nsec = 0;
+
+ rtc_begin_tm.tv_sec = tst_rtc_tm_to_time(&rtc_begin);
+
+ rtc_adjust = tst_timespec_add(rtc_begin_tm, elapsed);
+
+ tst_rtc_time_to_tm(rtc_adjust.tv_sec, &rtc_restore);
+
+ /* restore realtime clock based on monotonic delta */
+ if (tst_rtc_settime(rtc_dev, &rtc_restore))
+ tst_brk(TBROK | TERRNO, "tst_rtc_settime() realtime failed");
+}