diff --git a/afsk/main.c b/afsk/main.c index ee85e1c3..d61e48e3 100644 --- a/afsk/main.c +++ b/afsk/main.c @@ -112,7 +112,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 = (2 ^ 16 - value2) * (-1); + int twos = (2 ^ 16 - valuec2) * (-1); 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);