thooge
/
esp32-nmea2000-obp60
mirror of https://github.com/thooge/esp32-nmea2000-obp60.git
1
0
Fork 0
Code Releases Activity

Add power management sensor INA226

This commit is contained in:
norbert-walter 2022-03-24 17:02:15 +01:00
parent 9150552b34
commit 55c69e37e5
5 changed files with 167 additions and 133 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

15
lib/obp60task/AS5600.cpp
View File

@ -377,10 +377,14 @@ int AMS_5600::readOneByte(int in_adr)
Wire.write(in_adr);
Wire.endTransmission();
Wire.requestFrom(_ams5600_Address, (uint8_t) 1);
/*
while (Wire.available() == 0)
;
retVal = Wire.read();
*/
if(Wire.available() >= 1){
retVal = Wire.read();
}
return retVal;
}
@ -416,11 +420,20 @@ word AMS_5600::readTwoBytesTogether(int addr_in)
Wire.write(addr_in);
Wire.endTransmission();
Wire.requestFrom(_ams5600_Address, (uint8_t) 2);
/*
while (Wire.available() < 2)
;
int highByte = Wire.read();
int lowByte = Wire.read();
*/
int highByte = 0;
int lowByte = 0;
if (Wire.available() >= 2){
highByte = Wire.read();
lowByte = Wire.read();
}
// in case newer version of IC used the same address to
// store something else, get only the 3 bits

9
lib/obp60task/OBP60Hardware.h
View File

@ -22,11 +22,10 @@
// AS5600
#define AS5600_I2C_ADDR 0x36 // Addr. 0x36 (fix)
// INA226
#define SHUNT_VOLTAGE 0.75 // 75mV by max. current
#define INA226_I2C_ADDR1 0x40 // Addr. 0x40 (fix)
#define INA226_I2C_ADDR2 0x41 // Addr. 0x41 (fix)
#define INA226_I2C_ADDR3 0x44 // Addr. 0x44 (fix)
#define INA226_I2C_ADDR4 0x45 // Addr. 0x45 (fix)
#define SHUNT_VOLTAGE 0.075 // Shunt voltage in V by max. current (75mV)
#define INA226_I2C_ADDR1 0x41 // Addr. 0x41 (fix A0 = 5V, A1 = GND) for battery
#define INA226_I2C_ADDR2 0x44 // Addr. 0x44 (fix A0 = GND, A1 = 5V) for solar panels
#define INA226_I2C_ADDR3 0x45 // Addr. 0x45 (fix A0 = 5V, A1 = 5V) for generator
// SPI (E-Ink display, Extern Bus)
#define OBP_SPI_CS 5
#define OBP_SPI_DC 17

33
lib/obp60task/OBPSensorTask.cpp
View File

@ -68,7 +68,7 @@ void sensorTask(void *param){
Adafruit_BMP085 bmp085; // Evironment sensor BMP085 and BMP180
HTU21D sht21(HTU21D_RES_RH12_TEMP14); // Environment sensor SHT21 and HTU21
AMS_5600 as5600; // Rotation sensor AS5600
INA226 ina226_1(INA226_I2C_ADDR1);// Power management IC INA226
INA226 ina226_1(INA226_I2C_ADDR1);// Power management sensor INA226
// Init sensor stuff
bool gps_ready = false; // GPS initialized and ready to use
@ -211,6 +211,7 @@ void sensorTask(void *param){
float shuntResistor = 1.0; // Default value for shunt resistor
float current = 10.0; // Default value for max. current
float corrFactor = 1; // Correction factor for fix calibration
if(String(powsensor1) == "INA226"){
if (!ina226_1.begin()){
@ -218,13 +219,15 @@ void sensorTask(void *param){
}
else{
api->getLogger()->logDebug(GwLog::LOG,"Modul 1 INA226 found");
shuntResistor = 0.075 / float(shunt1.toInt()); // Calculate shunt resisitor for max. shunt voltage 75mV
shuntResistor = SHUNT_VOLTAGE / float(shunt1.toInt()); // Calculate shunt resisitor for max. shunt voltage 75mV
current = float(shunt1.toInt());
api->getLogger()->logDebug(GwLog::LOG,"Calibation INA226, Imax:%3.0fA Rs:%7.5fOhm Us:0.075V", current, shuntResistor);
ina226_1.setMaxCurrentShunt(current, shuntResistor);
api->getLogger()->logDebug(GwLog::LOG,"Calibation INA226, Imax:%3.0fA Rs:%7.5fOhm Us:%5.3f", current, shuntResistor, SHUNT_VOLTAGE);
// ina226_1.setMaxCurrentShunt(current, shuntResistor);
ina226_1.setMaxCurrentShunt(10, 0.01); // Calibration with fix values (because the original values outer range)
corrFactor = (current / 10) * (0.001 / shuntResistor) / (current / 100); // correction factor for fix calibration
sensors.batteryVoltage = ina226_1.getBusVoltage();
sensors.batteryCurrent = ina226_1.getCurrent();
sensors.batteryPower = ina226_1.getPower();
sensors.batteryCurrent = ina226_1.getCurrent() * corrFactor;
sensors.batteryPower = ina226_1.getPower() * corrFactor;
INA226_1_ready = true;
}
}
@ -262,7 +265,7 @@ void sensorTask(void *param){
}
// Read sensors and set values in sensor data
// Send supplay voltage value all 1s
if(millis() > starttime5 + 1000){
if(millis() > starttime5 + 1000 && String(powsensor1) == "off"){
starttime5 = millis();
sensors.batteryVoltage = (float(analogRead(OBP_ANALOG0)) * 3.3 / 4096 + 0.17) * 20; // Vin = 1/20
// Send to NMEA200 bus
@ -385,6 +388,22 @@ void sensorTask(void *param){
}
}
// Send power management value all 1s
if(millis() > starttime8 + 1000 && (String(powsensor1) == "INA219" || String(powsensor1) == "INA226")){
starttime8 = millis();
if(String(powsensor1) == "INA226" && INA226_1_ready == true){
sensors.batteryVoltage = ina226_1.getBusVoltage();
sensors.batteryCurrent = ina226_1.getCurrent() * corrFactor;
sensors.batteryPower = ina226_1.getPower() * corrFactor;
}
// Send battery data to NMEA200 bus
if(!isnan(sensors.batteryVoltage) && !isnan(sensors.batteryCurrent)){
// SetN2kDCBatStatus(N2kMsg, 0, sensors.batteryVoltage, sensors.batteryCurrent, N2kDoubleNA, 1);
SetN2kDCBatStatus(N2kMsg, 0, sensors.batteryVoltage, sensors.batteryCurrent, sensors.batteryPower, 1);
api->sendN2kMessage(N2kMsg);
}
}
shared->setSensorData(sensors);
}
vTaskDelete(NULL);

21
lib/obp60task/config.json
View File

@ -263,10 +263,10 @@
},
{
"name": "usePowSensor1",
"label": "Pow. Sensor 1",
"label": "Bat. Sensor 1",
"type": "list",
"default": "off",
"description": "Use external power management sensor via I2C bus [off|INA219|INA226|]",
"description": "Use external power management sensor via I2C bus for battery [off|INA219|INA226|]",
"list": [
"off",
"INA219",
@ -282,13 +282,14 @@
"label": "Shunt Sensor 1",
"type": "list",
"default": "10",
"description": "Shunt current value [10A|50A|100A|200A|300A|500A]",
"description": "Shunt current value [10A|50A|100A|200A|300A|400A|500A]",
"list": [
"10",
"50",
"100",
"200",
"300",
"400",
"500"
],
"category": "OBP60 Hardware",
@ -298,10 +299,10 @@
},
{
"name": "usePowSensor2",
"label": "Pow. Sensor 2",
"label": "Solar Sensor 2",
"type": "list",
"default": "off",
"description": "Use external power management sensor via I2C bus [off|INA219|INA226|]",
"description": "Use external power management sensor via I2C bus for solar panels [off|INA219|INA226|]",
"list": [
"off",
"INA219",
@ -317,13 +318,14 @@
"label": "Shunt Sensor 2",
"type": "list",
"default": "10",
"description": "Shunt current value [10A|50A|100A|200A|300A|500A]",
"description": "Shunt current value [10A|50A|100A|200A|300A|400A|500A]",
"list": [
"10",
"50",
"100",
"200",
"300",
"400",
"500"
],
"category": "OBP60 Hardware",
@ -333,10 +335,10 @@
},
{
"name": "usePowSensor3",
"label": "Pow. Sensor 3",
"label": "Gen. Sensor 3",
"type": "list",
"default": "off",
"description": "Use external power management sensor via I2C bus [off|INA219|INA226|]",
"description": "Use external power management sensor via I2C bus for generator [off|INA219|INA226|]",
"list": [
"off",
"INA219",
@ -352,13 +354,14 @@
"label": "Shunt Sensor 3",
"type": "list",
"default": "10",
"description": "Shunt current value [10A|50A|100A|200A|300A|500A]",
"description": "Shunt current value [10A|50A|100A|200A|300A|400A|500A]",
"list": [
"10",
"50",
"100",
"200",
"300",
"400",
"500"
],
"category": "OBP60 Hardware",

2
lib/obp60task/obp60task.h
View File

@ -20,7 +20,7 @@ DECLARE_INITFUNCTION(OBP60Init);
// OBP60 Task
void OBP60Task(GwApi *param);
DECLARE_USERTASK_PARAM(OBP60Task, 10000) // Need 10k RAM as stack size
DECLARE_USERTASK_PARAM(OBP60Task, 15000) // Need 15k RAM as stack size
DECLARE_CAPABILITY(obp60,true);
#endif