diff --git a/Source/main.c b/Source/main.c
--- a/Source/main.c
+++ b/Source/main.c
@@ -61,8 +61,8 @@ int main(void)
 	  {
 		  gps_update_data(); // Will always return at 1hz rate (default measurement rate)
 		  pressure_read();
+		  while(afsk_busy()); // ensure previous message finished
 		  aprs_send();
-		  //while(afsk_busy());
 
 		  last_transmission = HAL_GetTick();
 	  }