--- a/packages/hal/arm/sa11x0/assabet/current/src/assabet_misc.c
+++ b/packages/hal/arm/sa11x0/assabet/current/src/assabet_misc.c
@@ -246,3 +246,18 @@ plf_hardware_init(void)
     *SA11X0_GPIO_PIN_DIRECTION |= 0x000003FC;  // Bits 2..9
     *SA11X0_GPIO_PIN_OUTPUT_CLEAR = 0x000003FC;  // Bits 2..9
 }
+
+#include CYGHWR_MEMORY_LAYOUT_H
+typedef void code_fun(void);
+void assabet_program_new_stack(void *func)
+{
+    register CYG_ADDRESS stack_ptr asm("sp");
+    register CYG_ADDRESS old_stack asm("r4");
+    register code_fun *new_func asm("r0");
+    old_stack = stack_ptr;
+    stack_ptr = CYGMEM_REGION_ram + CYGMEM_REGION_ram_SIZE - sizeof(CYG_ADDRESS);
+    new_func = (code_fun*)func;
+    new_func();
+    stack_ptr = old_stack;
+    return;
+}