' INA3221 3 channel current and voltage I2C IC
 ' TassyJim Dec 2023
 OPTION EXPLICIT
 OPTION DEFAULT INTEGER
 OPTION BASE 0
 DIM INTEGER n , conf, gotime
 DIM FLOAT PVcurrent(99)
 CONST ina3221addr =&h40
 DIM FLOAT cur
 
 I2C2 OPEN 400,400
 INA3221_reset
 PRINT MM.I2C
 PRINT
 INA3221_enable_channel 7
 INA3221_set_Averaging 0
 INA3221_set_Volt_Time 3
 INA3221_set_Shunt_Time 3
 INA3221_set_Mode 3
 gotime = TIMER
 DO
 LOOP UNTIL INA3221_Ready()
 PRINT "Conversion time = "; TIMER-gotime; "mS"
 
 PAUSE 1
 PRINT
 FOR n = 0 TO 17
   conf = INA3221_read(n)
   PRINT HEX$(conf,4), conf
 NEXT n
 PRINT
 
 FOR n = 254 TO 255
   conf = INA3221_read(n)
   PRINT HEX$(conf,4)
 NEXT n
 PRINT
 PRINT INA3221_Current(1,0.00909)' 0.01 || with 0.1
 PRINT INA3221_Current(2,0.00909)
 PRINT INA3221_Current(3,0.00909)
 PRINT
 PRINT INA3221_ShuntVoltage(1)/1000000
 PRINT INA3221_ShuntVoltage(2)/1000000
 PRINT INA3221_ShuntVoltage(3)/1000000
 PRINT
 PRINT INA3221_Voltage(1)
 PRINT INA3221_Voltage(2)
 PRINT INA3221_Voltage(3)
 
 ' any PWM current source needs special consideration.
 cur = instCurrent(2,0.00856)
 PRINT cur ;" av A"
 PRINT MATH(MAX PVcurrent()); " max A"
 
 FOR n = 0 TO 99
   PRINT PVcurrent(n)
 NEXT n
 I2C2 CLOSE
 
FUNCTION instCurrent(channel AS INTEGER, r AS FLOAT) AS FLOAT
 'local integer register = channel * 2
 INA3221_enable_channel 1 << (channel-1)
 INA3221_set_Averaging 0
 INA3221_set_Volt_Time 1
 INA3221_set_Shunt_Time 1
 
 INA3221_set_Mode 1
 DO
 LOOP UNTIL INA3221_Ready()
 
 FOR n = 0 TO 99
   PVcurrent(n) = INA3221_Current(channel,r)
   INA3221_set_Mode 1
   'pause 0.1
 NEXT n
 instCurrent = MATH(MEAN PVcurrent())
END FUNCTION
 
FUNCTION INA3221_read(reg AS INTEGER) AS INTEGER
 LOCAL registers$
 I2C2 WRITE ina3221addr,0,1,reg
 I2C2 READ ina3221addr,0,2,registers$
 INA3221_read = STR2BIN(INT16,registers$,BIG)
END FUNCTION
 
 
SUB INA3221_write reg AS INTEGER, value AS INTEGER
 LOCAL INTEGER hibyte, lobyte
 lobyte = value AND &hFF
 hibyte = (value >> 8) AND &hFF
 I2C2 WRITE ina3221addr,0,3,reg,hibyte,lobyte
END SUB
 
SUB INA3221_reset
 LOCAL INTEGER config
 config = INA3221_read(0)
 config = config OR &h8000
 INA3221_write(0,config)
END SUB
 
SUB INA3221_set_Mode INA_Mode%
 LOCAL INTEGER config, x
 x = INA_Mode% AND &b111
 config = INA3221_read(0) AND &b0111111111111000
 config = config OR x
 INA3221_write(0,config)
END SUB
 
SUB INA3221_enable_channel INA_Mode%
 LOCAL INTEGER config, x
 x = (INA_Mode% AND &b111) << 12
 config = INA3221_read(0) AND &b0000111111111111
 config = config OR x
 INA3221_write(0,config)
END SUB
 
SUB INA3221_set_Averaging INA_Mode%
 LOCAL INTEGER config, x
 x = (INA_Mode% AND &b111) << 9
 config = INA3221_read(0) AND &b0111000111111111
 config = config OR x
 INA3221_write(0,config)
END SUB
 
SUB INA3221_set_Volt_Time INA_Mode%
 LOCAL INTEGER config, x
 x = (INA_Mode% AND &b111) << 6
 config = INA3221_read(0) AND &b0111111000111111
 config = config OR x
 INA3221_write(0,config)
END SUB
 
SUB INA3221_set_Shunt_Time INA_Mode%
 LOCAL INTEGER config,  x
 x = (INA_Mode% AND &b111) << 3
 config = INA3221_read(0) AND &b0111111111000111
 config = config OR x
 INA3221_write(0,config)
END SUB
 ' current shunt voltage register contains 40uV per bit
FUNCTION INA3221_ShuntVoltage(channel AS INTEGER)AS INTEGER
 LOCAL INTEGER register = channel * 2 - 1
 INA3221_ShuntVoltage = INA3221_read(register)/8 * 40 ' microvolts
END FUNCTION
 
FUNCTION INA3221_Current(channel AS INTEGER,r AS FLOAT) AS FLOAT
 LOCAL INTEGER uV
 uV = INA3221_ShuntVoltage(channel)
 INA3221_Current = uV/r /1000/1000 ' I = E/R
END FUNCTION
 
 ' volts register resolution 8 mV per bit
FUNCTION INA3221_Voltage(channel AS INTEGER) AS FLOAT
 LOCAL INTEGER register = channel * 2
 INA3221_Voltage = INA3221_read(register) / 1000 ' volts
END FUNCTION
 
FUNCTION INA3221_Ready() AS INTEGER
 INA3221_Ready = INA3221_read(15) AND 1
END FUNCTION

 ' 100 rapid current reads for PWM PV regulators
FUNCTION instCurrent(channel AS INTEGER, r AS FLOAT) AS FLOAT
 LOCAL INTEGER n,a,b, armed
 LOCAL FLOAT m, mi, currents
 INA3221_enable_channel 1 << (channel-1)
 INA3221_set_Averaging 0
 INA3221_set_Volt_Time 1
 INA3221_set_Shunt_Time 2
 
 INA3221_set_Mode 1
 DO
 LOOP UNTIL INA3221_Ready()
 
 FOR n = 0 TO 99
   PVcurrent(n) = INA3221_Current(channel,r)
   INA3221_set_Mode 1
   'pause 0.1
 NEXT n
 
 m = MATH(MAX PVcurrent())
 mi = MATH(MIN PVcurrent())
 IF (m - mi) > 3 THEN
   m = m -1
   mi = mi + 1
   FOR n = 0 TO 99
     IF PVcurrent(n) < mi THEN
       armed = 1
       EXIT FOR
     ENDIF
   NEXT n
   IF armed THEN
     FOR a = n TO 99
       IF PVcurrent(a) > m THEN EXIT FOR
     NEXT a
     armed = 0
     FOR n = 99 TO 0 STEP -1
       IF PVcurrent(n) > m THEN
         armed = 1
         EXIT FOR
       ENDIF
     NEXT n
     FOR b = n TO 0 STEP -1
       IF PVcurrent(b) < mi THEN EXIT FOR
     NEXT b
     b = b + 1
   ENDIF
   IF armed AND (b-a) > 20 THEN
     FOR n = a TO b
       currents = currents + PVcurrent(n)
     NEXT n
     IF verbose THEN PRINT STR$(currents/(b-a),3,2);" ";STR$(MATH(MEAN PVcurrent()),3,2);" ";a;" to ";b
     instCurrent = currents/(b-a)
   ELSE
     instCurrent = MATH(MEAN PVcurrent())
   ENDIF
 ELSE
   instCurrent = MATH(MEAN PVcurrent())
 ENDIF
 
END FUNCTION