diff --git a/src/testbench.c b/src/testbench.c
index 6246336..55767c2 100644
--- a/src/testbench.c
+++ b/src/testbench.c
@@ -9,6 +9,7 @@
 #include <libsys.h>
 #include <mips_gfx.h>
 #include <console.h>
+#include <assert.h>
 
 #include <gpio.h>
 #include <cop0.h>
@@ -31,7 +32,10 @@ extern int paranoia(int argc, char **argv);
 extern int calibrate_delay(void);
 
 gpio_if_t gpio_if;
-
+int g_cnt;
+box_t box;
+gfx_t gfx;
+int posx, posy;
 
 uint32_t* pf(void)
 {
@@ -115,16 +119,11 @@ void handler3(EXCEPTION_CONTEXT *xcp)
 
 	if((0x10 & *pUART_stat))
 	{
-		_putchar(0, (char)*pUART_data);
+		_putchar(1, (char)*pUART_data);
 	}
 
 }
 
-int g_cnt;
-box_t box;
-gfx_t gfx;
-int posx, posy;
-
 void handler7(EXCEPTION_CONTEXT *xcp)
 {
 	uint32_t volatile *pTim_stat = (uint32_t*)SYS_ITIM_STAT;
@@ -1171,15 +1170,14 @@ int main (void)
 	posx = posy = 0;
 	GFX_show(&gfx);
 
-//	interrupt_enable(7);
-//	*pTim_ctrl |= 3;
+	interrupt_enable(7);
+	*pTim_ctrl |= 3;
 	interrupt_enable(3);
-//	*pUART_stat |= (1 << 6);
+	*pUART_stat |= (1 << 6);
 
 	cnt = 0;
 	while (1)
 	{
-#if 0
 		for (i=0; i < 100000; i++)
 		{
 			interrupt_disable(7);
@@ -1188,7 +1186,7 @@ int main (void)
 		{
 			interrupt_enable(7);
 		}
-#endif
+
 		gpio_write(&gpio_if, GPIO_0_MASK_LED, GPIO_0_ALIGN_LED, GPIO_DATA_OFFSET, cnt);
 
 		printf("-------------------------------------------\n");