- fixed PRINT_REG_CHG

git-svn-id: http://moon:8086/svn/mips@82 a8ebac50-d88d-4704-bea3-6648445a41b3
2017-01-14 23:44:29 +00:00
parent 28c8957b96
commit 301865c2b4
2 changed files with 12 additions and 6 deletions
@@ -27,6 +27,8 @@ con_if_t con_if =
 };

 uart_if_t const *dbg_uart = NULL;
+volatile uint32_t *pGpioData = (uint32_t*)SYS_GPIO_0_DATA;
+volatile uint32_t *pGpioDir = (uint32_t*)SYS_GPIO_0_DIR;

 void dbg_uart_setup();

@@ -50,6 +52,7 @@ void board_init(void)
 	interrupt_init();

 	// Do some initializations here
+	*pGpioDir = 0xFF;
 }

 extern void dbg_handler(struct xcptcontext * xcp);
@@ -87,8 +90,11 @@ inline void _dbg_writechar(uart_if_t const *pUart, char c)
 inline char _dbg_readchar(uart_if_t const *pUart)
 {
 	// busy read
-	while(!(SYS_UART_BIT_RX_AVAIL & *pUart->pCTRL));
-
+	while(!(SYS_UART_BIT_RX_AVAIL & *pUart->pCTRL))
+	{
+		(*pGpioData)++;
+	}
+	(*pGpioData) = 0;
 	return (*pUart->pDATA & 0xFF);

 }