1 files changed, 134 insertions, 0 deletions
diff --git a/mig_test/software/monitor_functions.c b/mig_test/software/monitor_functions.c
new file mode 100644
index 0000000..5eda564
--- /dev/null
+++ b/mig_test/software/monitor_functions.c
@@ -0,0 +1,134 @@
+/*
+ * $HeadURL: https://svn.fzd.de/repo/concast/FWF_Projects/FWKE/hw_sp605/bsp_zpuahb/software/monitor_functions.c $
+ * $Date$
+ * $Author$
+ * $Revision$
+ */
+
+#include <types.h>
+#include "monitor.h"
+#include "ambainfo.h"          // apb_info, ahb_info
+#include "peripherie.h"
+
+
+volatile uint8_t running_direction = 0;
+
+
+/*
+    exit the monitor program
+*/
+uint32_t quit_function( void)
+{
+    monitor_run = FALSE;
+    return 0;
+}
+
+
+/*
+    do a memory dump
+    arguments:
+        start address
+        length
+*/
+uint32_t x_function( void)
+{
+    uint32_t  addr;
+    uint32_t  count;
+    uint32_t  index;
+    uint32_t* ptr;
+
+    addr  = monitor_get_argument_hex(1);
+    count = monitor_get_argument_hex(2);
+
+    // set minimum count, if count is not set
+    if (count == 0) count = 16;
+    
+    // we can only read at 32 bit aligned addresses
+    ptr = (uint32_t*)(addr & 0xfffffffc);
+
+    if (count != 1)
+    {
+        for (index = 0; index < count; index++)
+        {
+            if ( (index % 4) == 0) 
+            {
+                putstr("\n0x"); puthex(32, (uint32_t)ptr); putstr(" : ");
+            }
+            putstr("0x"); puthex( 32, *ptr); putchar(' ');
+            *ptr++;
+        }
+    }
+    else
+    // fast version without address
+    {
+        putstr("0x"); puthex( 32, *ptr);
+    }
+    putchar( '\n');
+    return 0;
+}
+
+
+/*
+    write specific value on memory
+    arguments:
+        address
+        count
+        value(0) .. value(n)
+*/
+uint32_t wmem_function( void)
+{
+    uint32_t  addr;
+    uint8_t   count;
+    uint8_t   index;
+    uint32_t  value;
+    uint32_t* ptr;
+    
+    addr  = monitor_get_argument_hex(1);
+    count = monitor_get_argument_int(2);
+
+    ptr  = (uint32_t*)addr; // automatic word aligned
+
+    index = 3;
+    while (count > 0)
+    {
+        value = monitor_get_argument_hex(index);
+        index++;
+        count--;
+        *ptr = value;
+        ptr++;
+    }
+    return count;
+}
+
+
+/*
+    clear screen
+*/
+uint32_t clear_function( void) 
+{
+    putchar('\f');
+    return 0;
+}
+
+
+////////////////////////////////////////////////////////////
+// reset function
+uint32_t reset_function( void)
+{
+    *reset_reg = 0x87654321;
+    return 1;
+}
+
+
+////////////////////////////////////////////////////////////
+// system info
+uint32_t system_info_function( void)
+{
+    uint8_t   verbose;
+
+    verbose = monitor_get_argument_int(1); 
+    ahb_info( verbose);
+    return 0;
+}
+
+