diff --git a/afsk/main.c b/afsk/main.c
index 816b9a03..b2f61858 100644
--- a/afsk/main.c
+++ b/afsk/main.c
@@ -113,7 +113,7 @@ struct SensorData read_sensor_data(struct SensorConfig sensor) {
     wiringPiI2CWriteReg16(sensor.fd, INA219_REG_CALIBRATION, sensor.calValue);
     int valuec1  = wiringPiI2CReadReg16(sensor.fd, INA219_REG_CURRENT);
     uint16_t valuec2 = (uint16_t)valuec1;
-    int twos = twosToInt(valuec2, 16);
+    int twos = twosToInt(valuec1, 16);
     float valuec3  = (float)(valuec2);
     data.current  = valuec2 / (float)sensor.currentDivider;
     printf("****** valuec1 %d   valuec2 %d  valuec3 %f  current %f  two's %d \n", valuec1, valuec2, valuec3, data.current, twos);
@@ -418,7 +418,7 @@ int get_tlm(int tlm[][5]) {
   return 0;
 }
 
-int twosToInt( val, len) {   // Convert twos compliment to integer
+int twosToInt(int val,int len) {   // Convert twos compliment to integer
 	
       printf("##############    val: %d", val);