Revert "Revert "Traces""

[proxmark3-svn] / armsrc / start.c

diff --git a/armsrc/start.c b/armsrc/start.c
index de2dd2f639c3e0d8c8cf86c963f6a9583c3729d8..d7332bda5682255bb03e4d306e87763d97218a51 100644 (file)
--- a/armsrc/start.c
+++ b/armsrc/start.c
@@ -1,12 +1,33 @@
-//-----------------------------------------------------------------------------\r
-// Just vector to AppMain(). This is in its own file so that I can place it\r
-// with the linker script.\r
-// Jonathan Westhues, Mar 2006\r
-//-----------------------------------------------------------------------------\r
-#include <proxmark3.h>\r
-#include "apps.h"\r
-\r
-void __attribute__((section(".startos"))) Vector(void)\r
-{\r
-       AppMain();\r
-}\r
+//-----------------------------------------------------------------------------
+// Jonathan Westhues, Mar 2006
+//
+// This code is licensed to you under the terms of the GNU GPL, version 2 or,
+// at your option, any later version. See the LICENSE.txt file for the text of
+// the license.
+//-----------------------------------------------------------------------------
+// Just vector to AppMain(). This is in its own file so that I can place it
+// with the linker script.
+//-----------------------------------------------------------------------------
+
+#include "proxmark3.h"
+#include "apps.h"
+
+extern char __data_start__, __data_src_start__,  __data_end__, __bss_start__, __bss_end__;
+void __attribute__((section(".startos"))) Vector(void)
+{
+       /* Stack should have been set up by the bootloader */
+       char *src, *dst, *end;
+
+       /* Set up (that is: clear) BSS. */
+       dst = &__bss_start__;
+       end = &__bss_end__;
+       while(dst < end) *dst++ = 0;
+
+       /* Set up data segment: Copy from flash to ram */
+       src = &__data_src_start__;
+       dst = &__data_start__;
+       end = &__data_end__;
+       while(dst < end) *dst++ = *src++;
+
+       AppMain();
+}