diff --git a/src/target/adiv5_swdp.c b/src/target/adiv5_swdp.c
index eebfb13..5097feb 100644
--- a/src/target/adiv5_swdp.c
+++ b/src/target/adiv5_swdp.c
@@ -45,11 +45,16 @@ int adiv5_swdp_scan(void)
 	}
 
 #if PC_HOSTED == 1
-	if (platform_swdptap_init())
+	if (platform_swdptap_init()) {
+		free(dp);
+		exit(-1);
+	}
 #else
-	if (swdptap_init())
-#endif
+	if (swdptap_init()) {
+		free(dp);
 		return -1;
+	}
+#endif
 
 	/* Switch from JTAG to SWD mode */
 	swd_proc.swdptap_seq_out(0xFFFFFFFF, 16);