X-Git-Url: http://git.joshuawise.com/firearm.git/blobdiff_plain/fb33d46774e2f2d95d54e7eb32754048624a63ca..121556d62c2c40b07a709ef038fa1ce0a67127c9:/tests/testbench.c

diff --git a/tests/testbench.c b/tests/testbench.c
index 0c1cb77..e708df6 100644
--- a/tests/testbench.c
+++ b/tests/testbench.c
@@ -1,5 +1,14 @@
 extern void putc(unsigned char c);
 
+int serial_getc (void)
+{
+	int c;
+	do
+		asm volatile("mrc 5, 0, %0, c1, c1, 1" : "=r"(c));
+	while (!(c & 0x100));
+	return c & 0xFF;
+}
+
 void puts(unsigned char *s)
 {
 	while (*s)
@@ -115,7 +124,9 @@ int main()
 		puts(": ");
 		t->test();
 	}
-	puts("Done!\n");
+	puts("Done! Echoing characters.\n");
 	
+	while (1)
+		putc(serial_getc());
 	return 0;
 }