diff --git a/firmware/include_board/board_common.h b/firmware/include_board/board_common.h
index fec8a05d..0c162cf0 100644
--- a/firmware/include_board/board_common.h
+++ b/firmware/include_board/board_common.h
@@ -24,6 +24,7 @@
 #include "stdlib.h"
 #include "string.h"
 #include "inttypes.h"
+#include "syscalls.h"
 
 #define MIN(a, b)       ((a < b) ? a : b)
 
diff --git a/firmware/include_board/syscalls.h b/firmware/include_board/syscalls.h
index a4e38656..34f37b80 100644
--- a/firmware/include_board/syscalls.h
+++ b/firmware/include_board/syscalls.h
@@ -50,8 +50,6 @@
 
 extern caddr_t _sbrk ( int incr ) ;
 
-extern int link( char *old, char *new ) ;
-
 extern int _close( int file ) ;
 
 extern int _fstat( int file, struct stat *st ) ;
@@ -63,3 +61,5 @@ extern int _lseek( int file, int ptr, int dir ) ;
 extern int _read(int file, char *ptr, int len) ;
 
 extern int _write( int file, char *ptr, int len ) ;
+
+extern void mdelay(unsigned int msecs);
diff --git a/firmware/src_board/board_lowlevel.c b/firmware/src_board/board_lowlevel.c
index 807df221..625160e7 100644
--- a/firmware/src_board/board_lowlevel.c
+++ b/firmware/src_board/board_lowlevel.c
@@ -162,4 +162,24 @@ extern WEAK void LowLevelInit( void )
     PMC->PMC_MCKR = BOARD_MCKR ;
     /* wait for master clock to be ready */
     for ( timeout = 0; !(PMC->PMC_SR & PMC_SR_MCKRDY) && (timeout++ < CLOCK_TIMEOUT) ; );
+
+    /* Configure SysTick for 1ms */
+    SysTick_Config(BOARD_MCK/1000);
+}
+
+/* SysTick based delay function */
+
+volatile uint32_t jiffies;
+
+/* Interrupt handler for SysTick interrupt */
+void SysTick_Handler(void)
+{
+	jiffies++;
+}
+
+void mdelay(unsigned int msecs)
+{
+	uint32_t jiffies_start = jiffies;
+	do {
+	} while ((jiffies - jiffies_start) < msecs);
 }