2 files changed, 23 insertions, 2 deletions

diff --git a/utils/hwstub/stub/stmp/Makefile b/utils/hwstub/stub/stmp/Makefile
index 14e6d0fbba..3ac7e3bbd4 100644
--- a/utils/hwstub/stub/stmp/Makefile
+++ b/utils/hwstub/stub/stmp/Makefile
@@ -5,10 +5,16 @@ CC=arm-elf-eabi-gcc
 LD=arm-elf-eabi-gcc
 AS=arm-elf-eabi-gcc
 OC=arm-elf-eabi-objcopy
+SBTOELF=$(CURDIR)/../../../imxtools/sbtools/elftosb
 DEFINES=
 INCLUDES=-I$(CURDIR)
 GCCOPTS=-mcpu=arm926ej-s
 BUILD_DIR=$(CURDIR)/build/
 ROOT_DIR=$(CURDIR)/..
- 
-include ../hwstub.make
\ No newline at end of file
+EXEC=$(BUILD_DIR)/hwstub.sb
+
+include ../hwstub.make
+
+$(BUILD_DIR)/hwstub.sb: $(EXEC_BIN)
+        $(call PRINTS,SBTOELF $(@F))
+        $(SILENT)$(SBTOELF) -z -c hwstub.db -o $@ $<
\ No newline at end of file
diff --git a/utils/hwstub/stub/stmp/target.c b/utils/hwstub/stub/stmp/target.c
index 390480a71c..9b005063bd 100644
--- a/utils/hwstub/stub/stmp/target.c
+++ b/utils/hwstub/stub/stmp/target.c
@@ -273,3 +273,18 @@ void target_exit(void)
             return;
     }
 }
+
+void target_udelay(int us)
+{
+    uint32_t cur = HW_DIGCTL_MICROSECONDS;
+    uint32_t end = cur + us;
+    if(cur < end)
+        while(HW_DIGCTL_MICROSECONDS < end) {}
+    else
+        while(HW_DIGCTL_MICROSECONDS >= cur) {}
+}
+
+void target_mdelay(int ms)
+{
+    return target_udelay(ms * 1000);
+}