From 360b25ab0f8df087d6ad986e4cd6fa2cff1d256b Mon Sep 17 00:00:00 2001
From: Damien George <damien.p.george@gmail.com>
Date: Sat, 8 Mar 2014 15:17:10 +0000
Subject: [PATCH] stm: Add udelay (delay in microseconds).

---
 stm/main.c         | 11 +++++++++++
 stm/qstrdefsport.h |  1 +
 2 files changed, 12 insertions(+)

diff --git a/stm/main.c b/stm/main.c
index 9f4fec84d5..e5f5d4e763 100644
--- a/stm/main.c
+++ b/stm/main.c
@@ -110,6 +110,16 @@ mp_obj_t pyb_delay(mp_obj_t count) {
     return mp_const_none;
 }
 
+mp_obj_t pyb_udelay(mp_obj_t usec) {
+    uint32_t count = 0;
+    const uint32_t utime = (168 * mp_obj_get_int(usec) / 5);
+    for (;;) {
+        if (++count > utime) {
+            return mp_const_none;
+        }
+    }
+}
+
 void fatality(void) {
     led_state(PYB_LED_R1, 1);
     led_state(PYB_LED_G1, 1);
@@ -415,6 +425,7 @@ soft_reset:
         rt_store_attr(m, MP_QSTR_main, rt_make_function_n(1, pyb_main));
         rt_store_attr(m, MP_QSTR_sync, rt_make_function_n(0, pyb_sync));
         rt_store_attr(m, MP_QSTR_delay, rt_make_function_n(1, pyb_delay));
+        rt_store_attr(m, MP_QSTR_udelay, rt_make_function_n(1, pyb_udelay));
 #if MICROPY_HW_HAS_SWITCH
         rt_store_attr(m, MP_QSTR_switch, (mp_obj_t)&pyb_switch_obj);
 #endif
diff --git a/stm/qstrdefsport.h b/stm/qstrdefsport.h
index 645c2b8c72..2978f8276d 100644
--- a/stm/qstrdefsport.h
+++ b/stm/qstrdefsport.h
@@ -11,6 +11,7 @@ Q(main)
 Q(sync)
 Q(gc)
 Q(delay)
+Q(udelay)
 Q(switch)
 Q(SW)
 Q(servo)