firmware/src/modules/Telemetry/Sensor/MCP9808Sensor.cpp

#include "../mesh/generated/telemetry.pb.h"
#include "configuration.h"
#include "TelemetrySensor.h"
#include "MCP9808Sensor.h"
#include <Adafruit_MCP9808.h>

MCP9808Sensor::MCP9808Sensor() : TelemetrySensor {} {
}

int32_t MCP9808Sensor::runOnce() {
    unsigned mcp9808Status;
    // Default i2c address for MCP9808
    mcp9808Status = mcp9808.begin(0x18); 
    if (!mcp9808Status) {
        DEBUG_MSG("Could not find a valid MCP9808 sensor, check wiring, address, sensor ID!");
    } else {
        DEBUG_MSG("TelemetrySensor: Opened MCP9808 on default i2c bus");
        // Reduce resolution from 0.0625 degrees (precision) to 0.125 degrees (high). 
        mcp9808.setResolution(2);
    }
    return (MCP_SENSOR_MINIMUM_WAIT_TIME_BETWEEN_READS);
}

bool MCP9808Sensor::getMeasurement(Telemetry *measurement) {
    measurement->temperature = mcp9808.readTempC();

    return true;
}