Initial version

Committed on the Free edition of March Hare Software CVSNT Server. Upgrade to CVS Suite for more features and support: http://march-hare.com/cvsnt/ git-svn-id: http://moon:8086/svn/vhdl/trunk@789 cc03376c-175c-47c8-b038-4cd826a8556b
2010-03-13 14:05:15 +00:00
parent 9ac3c738db
commit ab41a4f80f
9 changed files with 1066 additions and 0 deletions
@@ -0,0 +1,214 @@
+#include <sys/times.h>
+#include <sys/time.h>
+#include <sys/resource.h>
+#include <sys/stat.h>
+#include <errno.h>
+#include <stdlib.h>
+#include "libsys_boot.h"
+
+// ---------------------------------------------------------------------------------
+// MIPS specific
+UINT32 CP0_SR_read(void)
+{
+	UINT32 result;
+
+	__asm
+	(
+		"mfc0   %[val], $12\n"
+		: [val] "=r" (result)
+	);
+
+	return result;
+}
+
+void CP0_SR_write(UINT32 val)
+{
+	__asm
+	(
+		"mtc0   %[val], $12\n"
+		: /* no output */
+		: [val] "r" (val)
+	);
+}
+
+UINT32 CP0_CR_read(void)
+{
+	UINT32 result;
+
+	__asm
+	(
+		"mfc0   %[val], $13\n"
+		: [val] "=r" (result)
+	);
+
+	return result;
+}
+
+void CP0_CR_write(UINT32 val)
+{
+	__asm
+	(
+		"mtc0   %[val], $13\n"
+		:
+		: [val] "r" (val)
+	);
+}
+
+UINT32 CP0_PRID_read(void)
+{
+	UINT32 result;
+
+	__asm
+	(
+		"mfc0   %[val], $15\n"
+		: [val] "=r" (result)
+	);
+
+	return result;
+}
+
+// ---------------------------------------------------------------------------------
+char readchar(void)
+{
+	volatile UINT32 *pUART_stat = (UINT32*)SYS_UART_STAT;
+	volatile UINT32 *pUART_data = (UINT32*)SYS_UART_DATA;
+
+	while(!(0x10 & *pUART_stat));
+
+	return (char)*pUART_data;
+}
+
+void writechar(char c)
+{
+	volatile UINT32 *pUART_stat = (UINT32*)SYS_UART_STAT;
+	volatile UINT32 *pUART_data = (UINT32*)SYS_UART_DATA;
+
+	while((0x02 & *pUART_stat) != 0);
+
+	*pUART_data = (UINT32)c;
+}
+
+void _putchar(char c)
+{
+	if (c == 0x0A)
+	{
+		writechar(0x0D);
+	}
+	writechar(c);
+}
+
+int sputs(char *pStr)
+{
+	char *start;
+	start = pStr;
+
+	while(*pStr)
+		_putchar(*(pStr++));
+
+	return pStr - start;
+}
+
+void print_byte(char byte)
+{
+	int i;
+	unsigned char c, nibble;
+
+	for (i=0; i < 2; i++)
+	{
+		nibble = (char)((byte >> 4) & 0xF);
+		byte <<= 4;
+
+		if (nibble < 10)
+			c = nibble + '0';
+		else
+			c = nibble + 'A' - 10;
+
+		_putchar(c);
+	}
+}
+
+void print_word(int word)
+{
+	int i;
+	unsigned char c, nibble;
+
+	for (i=0; i < 4; i++)
+	{
+		c = (char) (word >> 24);
+		print_byte(c);
+		word <<= 8;
+	}
+}
+
+// ---------------------------------------------------------------------------------
+// PrintBuffer8()
+// Prints byte buffer as hex and ascii interpretation
+// ---------------------------------------------------------------------------------
+// _Parameters :
+// pBuf:       : IN: Buffer to display
+// nbpr        : Number of bytes per row to display
+// len         : Length of input buffer
+// _Return:      none
+//
+// ---------------------------------------------------------------------------
+void PrintBuffer8(UINT8 *pBuf, int nbpr, int len)
+{
+	memdump(pBuf, 1, nbpr, len);
+}
+
+void memdump(UINT8 *pBuf, int print_offset_only, int num_bytes_per_row, int len)
+{
+    int i, j, cnt_hex, cnt_asc, base;
+    unsigned char c;
+
+    i = j = 0;
+    cnt_hex = len;
+    cnt_asc = len;
+    base = 0;
+	if (!print_offset_only)
+		base = (int)pBuf;
+
+    do
+    {
+        print_word(base + i);
+        sputs(": ");
+        for (j=0; j < num_bytes_per_row; j++)
+        {
+            if (cnt_hex)
+            {
+    		    print_byte(pBuf[i+j]);
+		        sputs(" ");
+                cnt_hex--;
+            }
+            else
+            {
+                sputs("   ");
+                break;
+            }
+
+        }
+
+        sputs("   ");
+        for (j=0; j < num_bytes_per_row; j++)
+        {
+            if (cnt_asc)
+            {
+                c = pBuf[i+j];
+                if((c < 0x20) || (c > 0x7F))
+                    c = '.';
+
+                _putchar(c);
+                cnt_asc--;
+            }
+            else
+            {
+                sputs(" ");
+                break;
+            }
+        }
+        sputs("\n");
+        i += num_bytes_per_row;
+
+    } while (cnt_hex);
+}
+