diff --git a/main.c b/main.c
index 544a3f78..14aef8b7 100644
--- a/main.c
+++ b/main.c
@@ -1030,13 +1030,16 @@ void get_tlm(void) {
         channel, upper_digit(tlm[channel][4]), lower_digit(tlm[channel][4]));
       //        printf("%s",tlm_str);
 
-       if (mode == AFSK) 
-	  sprintf(tlm_str, "%4.2f%V 5.1%fmA ", voltage[map[BAT]], current[map[BAT]]);
-
-       strcat(str, tlm_str);
+       if (mode != AFSK) 
+         strcat(str, tlm_str);
 
     }
 
+    if (mode == AFSK) {
+      sprintf(tlm_str, "%4.2f%V 5.1%fmA ", batteryVoltage, batteryVoltage);
+      strcat(str, tlm_str);
+    }  
+
     // read payload sensor if available
 /*
     char sensor_payload[500];