diff --git a/drivers/soc/rockchip/rk_fiq_debugger.c b/drivers/soc/rockchip/rk_fiq_debugger.c index f1ceb2b55964..5f0b2891660d 100755 --- a/drivers/soc/rockchip/rk_fiq_debugger.c +++ b/drivers/soc/rockchip/rk_fiq_debugger.c @@ -40,6 +40,7 @@ #include #include #include +#include #ifdef CONFIG_FIQ_DEBUGGER_TRUST_ZONE #include @@ -99,6 +100,8 @@ static int debug_port_init(struct platform_device *pdev) int dll = 0, dlm = 0; struct rk_fiq_debugger *t; + console_lock(); + t = container_of(dev_get_platdata(&pdev->dev), typeof(*t), pdata); if (rk_fiq_read(t, UART_LSR) & UART_LSR_DR) @@ -140,6 +143,8 @@ static int debug_port_init(struct platform_device *pdev) /* disbale loop back mode */ rk_fiq_write(t, 0x0, UART_MCR); + console_unlock(); + return 0; }