AP_HAL_ChibiOS: implement 'uint16_t millis16'

7 years ago · 8cfedd8b46
1 changed files with 5 additions and 0 deletions
--- a/libraries/AP_HAL_ChibiOS/system.cpp
+++ b/libraries/AP_HAL_ChibiOS/system.cpp
@ -159,6 +159,11 @@ uint32_t millis()
				@@ -159,6 +159,11 @@ uint32_t millis()
    return hrt_millis32();
 }

+uint16_t millis16()
+{
+    return hrt_millis32() & 0xFFFF;
+}
+
 uint64_t micros64()
 {
    return hrt_micros64();