From 95d9518068483d68dfbd6f1377728be56f40d07d Mon Sep 17 00:00:00 2001
From: Ian Chamberlain <ian.h.chamberlain@gmail.com>
Date: Tue, 1 Feb 2022 18:09:45 -0500
Subject: [PATCH] Implement CLOCK_MONOTONIC

---
 src/lib.rs | 21 +++++++++++++++++++++
 1 file changed, 21 insertions(+)

diff --git a/src/lib.rs b/src/lib.rs
index e57233e..de11e9c 100644
--- a/src/lib.rs
+++ b/src/lib.rs
@@ -1,10 +1,17 @@
 #![no_std]
 
+use core::any::Any;
+use core::convert::{TryFrom, TryInto};
 use core::mem::MaybeUninit;
+use core::num::TryFromIntError;
 use core::ptr;
 
 extern crate libc;
 
+// avoid conflicting a real POSIX errno by using a value < 0
+// should we define this in ctru-sys somewhere or something?
+const ECTRU: libc::c_int = -1;
+
 /// Call this somewhere to force Rust to link this module.
 /// The call doesn't need to execute, just exist.
 ///
@@ -62,6 +69,20 @@ unsafe extern "C" fn clock_gettime(
                 (*tp).tv_sec = tv.tv_sec;
             }
         }
+        libc::CLOCK_MONOTONIC => {
+            if let Ok(tick) = i64::try_from(ctru_sys::svcGetSystemTick()) {
+                let sysclock = i64::from(ctru_sys::SYSCLOCK_ARM11);
+                (*tp).tv_sec = tick / sysclock;
+
+                // This cast to i32 is safe because the remainder will always be less than sysclock,
+                // which fits in an i32, and it's required to convert to f64.
+                let remainder = f64::from((tick - sysclock * (*tp).tv_sec) as i32);
+                // Casting to int rounds towards zero, which seems fine in this case.
+                (*tp).tv_nsec = (1000.0 * remainder / ctru_sys::CPU_TICKS_PER_USEC) as i32;
+            } else {
+                *__errno() = ECTRU
+            }
+        }
         _ => *__errno() = libc::EINVAL,
     }