diff --git a/afsk/telem.c b/afsk/telem.c index a3d5d848..648cb041 100644 --- a/afsk/telem.c +++ b/afsk/telem.c @@ -91,6 +91,7 @@ struct SensorData read_sensor_data(struct SensorConfig sensor) { wiringPiI2CWriteReg16(sensor.fd, INA219_REG_CALIBRATION, sensor.calValue); wiringPiI2CWriteReg16(sensor.fd, INA219_REG_CONFIG, sensor.config); wiringPiI2CWriteReg16(sensor.fd, INA219_REG_CALIBRATION, sensor.calValue); + delay(1); int value = wiringPiI2CReadReg16(sensor.fd, INA219_REG_CURRENT); if (value == -1) { @@ -104,6 +105,7 @@ struct SensorData read_sensor_data(struct SensorConfig sensor) { value = (wiringPiI2CRead(sensor.fd) << 8 ) | wiringPiI2CRead (sensor.fd); data.voltage = ((float)(value >> 3) * 4) / 1000; // power has very low resolution, seems to step in 512mW values + delay(1); data.power = (float) wiringPiI2CReadReg16(sensor.fd, INA219_REG_POWER) * (float) sensor.powerMultiplier; return data;