NetBurner Community Forum

Code: Select all

void ReadSensors()
{
    int Bits;
    BYTE ch1, ch2, config;
    BYTE address = 0x6C;		// Address of the MCP3424 for 4 channel
    BYTE Status;
    BYTE buf[10];

    OSCritEnter(&ShareI2C, 0);
    Status = I2CReadBuf(address, buf, 3, true);
    if(Status > 3)
    {
        OSCritLeave(&ShareI2C);
        return;
    }
    OSCritLeave(&ShareI2C);

    ch1 = buf[0];
    ch2 = buf[1];
    config = buf[2];

    if(!(config & 0x80))			// Not doing a conversion?
    {
        Bits = ((int) ch1 << 8) + ch2;

        Sensor[ADCChannel].Current = EngUnits(Bits, 4, 20, 6400, 32000);
        Sensor[ADCChannel].Calculated = EngUnits(Bits, 0,
                                                                   ConfigData.SensorRange[ADCChannel],
                                                                   6400, 32000) +
                                                                   ConfigData.SensorOffset[ADCChannel];
        ADCChannel++;
        if(ADCChannel > 3) ADCChannel = 0;
        //
        // Start a conversion going
        //
        buf[0] = 0x88 | ADCChannel << 5;
        OSCritEnter(&ShareI2C, 0);
        I2CSendBuf(address, buf, 1, true);
        OSCritLeave(&ShareI2C);
    }
}