diff --git a/src/modules/px4iofirmware/sbus.c b/src/modules/px4iofirmware/sbus.c
index 6608392d04..32be93d4c9 100644
--- a/src/modules/px4iofirmware/sbus.c
+++ b/src/modules/px4iofirmware/sbus.c
@@ -114,12 +114,14 @@ sbus_init(const char *device)
 		debug("S.Bus: open failed");
 	}
 
-	ENABLE_SBUS_OUT(true);
+	stm32_configgpio(GPIO_SBUS_OENABLE);
 
 	while (1) {
+		ENABLE_SBUS_OUT(true);
 		const char* hello = "HELLO WORLD";
 		if (write(sbus_fd, hello, strlen(hello)) != strlen(hello))
 			break;
+		ENABLE_SBUS_OUT(false);
 	}
 
 	return sbus_fd;