diff --git a/afsk/main.c b/afsk/main.c index f7a205fc..6a81e415 100644 --- a/afsk/main.c +++ b/afsk/main.c @@ -111,8 +111,11 @@ struct SensorData read_sensor_data(struct SensorConfig sensor) { wiringPiI2CWriteReg16(sensor.fd, INA219_REG_CONFIG, sensor.config); wiringPiI2CWriteReg16(sensor.fd, INA219_REG_CALIBRATION, sensor.calValue); // data.current = (float)((int16_t)wiringPiI2CReadReg16(sensor.fd, INA219_REG_CURRENT)) / (float)sensor.currentDivider; + int16_t value0 = (int16_t)wiringPiI2CReadReg16(sensor.fd, INA219_REG_CURRENT); int16_t value = (int16_t)((wiringPiI2CRead(sensor.fd) << 8 ) | wiringPiI2CRead (sensor.fd)); - data.current = (float)value / (float)sensor.currentDivider;; + float value1 = (float) value; + data.current = value1 / (float)sensor.currentDivider; + printf("********* value0 %d value1 %d value %d data.current %f \n", value0, value1, value, data.current); uint16_t value2 = (uint16_t)wireReadRegister(sensor.fd, INA219_REG_BUSVOLTAGE); data.voltage = ((double)(value2 >> 3) * 4) / 1000; data.power = (float)((uint16_t)wiringPiI2CReadReg16(sensor.fd, INA219_REG_POWER)) * (float)sensor.powerMultiplier;