#define ADDR 0x40 // I2C address
#define UR   0.1    // R (Om)
#define AVG  0B100
#define VBUS 0B111
#define CH   0B111
#define VSH  0B111
#define MODE 0B111

#include <Wire.h>

void setup() {
    Wire.begin();
    Serial.begin(9600);
    delay(100);
    I2C_write(0x00, 0x00|(CH<<12)|(AVG<<9)|(VBUS<<6)|(VSH<<3)|MODE); // Configuration Register
    Serial.print("Manufacturer ID ");Serial.println(I2C_read(0xFE),HEX);
    Serial.print("Die ID ");Serial.println(I2C_read(0xFF),HEX);
}

void loop() {
    int ur1=(I2C_read(0x01)>>3);
    int u1=(I2C_read(0x02)>>3);
    int ur2=(I2C_read(0x03)>>3);
    int u2=(I2C_read(0x04)>>3);
    int ur3=(I2C_read(0x05)>>3);
    int u3=(I2C_read(0x06)>>3);
    
    Serial.print("Ur_1 ");Serial.print(ur1*0.04,3);Serial.println(" mV");
    Serial.print("I_1 ");Serial.print(ur1*0.04/UR,1);Serial.println(" mA");
    Serial.print("U_1 ");Serial.print(u1*0.008);Serial.println(" V");
    Serial.println();
    Serial.print("Ur_2 ");Serial.print(ur2*0.04,3);Serial.println(" mV");
    Serial.print("I_2 ");Serial.print(ur2*0.04/UR,1);Serial.println(" mA");
    Serial.print("U_2 ");Serial.print(u2*0.008);Serial.println(" V");
    Serial.println();
    Serial.print("Ur_3 ");Serial.print(ur3*0.04,3);Serial.println(" mV");
    Serial.print("I_3 ");Serial.print(ur3*0.04/UR,1);Serial.println(" mA");
    Serial.print("U_3 ");Serial.print(u3*0.008);Serial.println(" V");
    Serial.println();
    delay(2000);
}


unsigned int I2C_read(byte reg){
  Wire.beginTransmission(ADDR);
  Wire.write(reg);
  Wire.endTransmission();
  Wire.requestFrom(ADDR,2);
  while(Wire.available()<1);
  unsigned int value = (Wire.read()<<8) | Wire.read();
  return value;
  } 

void I2C_write(byte reg, unsigned int data){  
  Wire.beginTransmission(ADDR);
  Wire.write(reg);
  Wire.write((data&0xFF00)>>8);
  Wire.write(data&0x00FF);
  Wire.endTransmission();
  }  

#include <Wire.h>
#include <INA3221.h>

#define SERIAL_SPEED     9600  // serial baud rate
#define PRINT_DEC_POINTS 3       // decimal points to print

// Set I2C address to 0x41 (A0 pin -> VCC)
INA3221 ina3221(INA3221_ADDR40_GND);

void setup() {
    Serial.begin(SERIAL_SPEED);

    while (!Serial) {
        delay(1);
    }

    ina3221.begin();
    ina3221.reset();

    // Set shunt resistors to 10 mOhm for all channels
    ina3221.setShuntRes(100, 100, 100);

    // Set series filter resistors to 10 Ohm for all channels.
    // Series filter resistors introduce error to the current measurement.
    // The error can be estimated and depends on the resitor values and the bus
    // voltage.
    ina3221.setFilterRes(100, 100, 100);
}

void loop() {
    float current[3];
    float current_compensated[3];
    float voltage[3];

    current[0]             = ina3221.getCurrent(INA3221_CH1);
    current_compensated[0] = ina3221.getCurrentCompensated(INA3221_CH1);
    voltage[0]             = ina3221.getVoltage(INA3221_CH1);

    current[1]             = ina3221.getCurrent(INA3221_CH2);
    current_compensated[1] = ina3221.getCurrentCompensated(INA3221_CH2);
    voltage[1]             = ina3221.getVoltage(INA3221_CH2);

    current[2]             = ina3221.getCurrent(INA3221_CH3);
    current_compensated[2] = ina3221.getCurrentCompensated(INA3221_CH3);
    voltage[2]             = ina3221.getVoltage(INA3221_CH3);

    Serial.print("Channel 1: \n Current: ");
    Serial.print(current[0], PRINT_DEC_POINTS);
    Serial.print("A\n Compensated current: ");
    Serial.print(current_compensated[0], PRINT_DEC_POINTS);
    Serial.print("\n Voltage: ");
    Serial.print(voltage[0], PRINT_DEC_POINTS);
    Serial.println("V");

    Serial.print("Channel 2: \n Current: ");
    Serial.print(current[1], PRINT_DEC_POINTS);
    Serial.print("A\n Compensated current: ");
    Serial.print(current_compensated[1], PRINT_DEC_POINTS);
    Serial.print("\n Voltage: ");
    Serial.print(voltage[1], PRINT_DEC_POINTS);
    Serial.println("V");

    Serial.print("Channel 3: \n Current: ");
    Serial.print(current[2], PRINT_DEC_POINTS);
    Serial.print("A\n Compensated current: ");
    Serial.print(current_compensated[2], PRINT_DEC_POINTS);
    Serial.print("\n Voltage: ");
    Serial.print(voltage[2], PRINT_DEC_POINTS);
    Serial.println("V\n");

    delay(1000);
}