diff --git a/src/drivers/px4io/px4io_uploader.cpp b/src/drivers/px4io/px4io_uploader.cpp
index 986e39dc88..fb16f891f6 100644
--- a/src/drivers/px4io/px4io_uploader.cpp
+++ b/src/drivers/px4io/px4io_uploader.cpp
@@ -274,12 +274,11 @@ int
 PX4IO_Uploader::recv_bytes(uint8_t *p, unsigned count)
 {
 	int ret = OK;
-	while (count) {
+	while (count--) {
 		ret = recv_byte_with_timeout(p++, 5000);
 
 		if (ret != OK)
 			break;
-		count--;
 	}
 	return ret;
 }