diff --git a/test_pool/peripherals/operating_system/test_os_d003.c b/test_pool/peripherals/operating_system/test_os_d003.c
index c0a8b3e6..828ee322 100644
--- a/test_pool/peripherals/operating_system/test_os_d003.c
+++ b/test_pool/peripherals/operating_system/test_os_d003.c
@@ -218,6 +218,14 @@ payload1()
                  return;
               }
 
+               val_peripheral_uart_setup();
+               /* If UART is used by other app (optee/TF) skip it */
+               if (((uart_reg_read(BSA_UARTIMSC, WIDTH_BIT32)) & 0x10))
+               {
+                    count--;
+                    continue;
+               }
+
               /* Install ISR */
               if (val_gic_install_isr(int_id, isr)) {
                  val_print(ACS_PRINT_ERR, "\n       GIC Install Handler Failed...", 0);
@@ -225,7 +233,6 @@ payload1()
                  return;
               }
 
-              val_peripheral_uart_setup();
               uart_enable_txintr();
               val_print_raw(l_uart_base, g_print_level,
                             "\n       Test Message                          ", 0);