diff --git a/main.c b/main.c
index b0dffaee..79490305 100644
--- a/main.c
+++ b/main.c
@@ -2321,23 +2321,27 @@ void get_tlm_fc() {
 	printf("Amps: %f %f %f %f \n", current[map[BAT]], current[map[PLUS_X]] , current[map[PLUS_Y]], current[map[PLUS_Z]]); 
 
 	float xmax = (voltage[map[PLUS_X]] > voltage[map[MINUS_X]]) ? voltage[map[PLUS_X]] : voltage[map[MINUS_X]];
+	float ymax = (voltage[map[PLUS_Y]] > voltage[map[MINUS_Y]]) ? voltage[map[PLUS_Y]] : voltage[map[MINUS_Y]];
+	float zmax = (voltage[map[PLUS_Z]] > voltage[map[MINUS_Z]]) ? voltage[map[PLUS_Z]] : voltage[map[MINUS_Z]];
+
+	printf("Vmax: %f %f %f \n", xmax, ymax, zmax);
 	
 	uint16_t x = (uint16_t)(xmax * 1000) & 0x3fff;  // 14 bits
-	uint16_t y = (uint16_t)((voltage[map[PLUS_Y]] + voltage[map[MINUS_Y]]) * 1000) & 0x3fff;
-	uint16_t z = (uint16_t)((voltage[map[PLUS_Z]] + voltage[map[MINUS_Z]]) * 1000) & 0x3fff;
+	uint16_t y = (uint16_t)(ymax * 1000) & 0x3fff;
+	uint16_t z = (uint16_t)(zmax * 1000) & 0x3fff;
 	uint16_t b = (uint16_t)(voltage[map[BAT]] * 1000) & 0x3fff;
 
-	uint16_t ix = (uint16_t)((current[map[PLUS_X]] + current[map[MINUS_X]]) * 1000) & 0x3ff;  // 10 bits
-	uint16_t iy = (uint16_t)((current[map[PLUS_Y]] + current[map[MINUS_Y]]) * 1000) & 0x3ff;
-	uint16_t iz = (uint16_t)((current[map[PLUS_Z]] + current[map[MINUS_Z]]) * 1000) & 0x3ff;
+	uint16_t ix = (uint16_t)((current[map[PLUS_X]] + current[map[MINUS_X]])) & 0x3ff;  // 10 bits
+	uint16_t iy = (uint16_t)((current[map[PLUS_Y]] + current[map[MINUS_Y]])) & 0x3ff;
+	uint16_t iz = (uint16_t)((current[map[PLUS_Z]] + current[map[MINUS_Z]])) & 0x3ff;
 
 	uint16_t ic = 0; 
 	uint16_t ib = 0;
 	
 	if (current[map[BAT]] < 0 ) 
-		ic = (uint16_t)(current[map[BAT]] * (-1000)) & 0x3ff;  // charging current
+		ic = (uint16_t)(current[map[BAT]] * (-1)) & 0x3ff;  // charging current
 	else 
-		ib = (uint16_t)(current[map[BAT]] * 1000) & 0x3ff;  // supplying current
+		ib = (uint16_t)(current[map[BAT]]) & 0x3ff;  // supplying current
 	
 //	x = 0xfffc; // 0xffff;
 //	y = 0x0; // 0x0000;