mbusgateway3variant/cube/User/Src/mbusParserExt.c

86 lines
2.6 KiB
C

#include <mbus/mbus-protocol.h>
#include <mbusParserExt.h>
#include <logger.h>
#include <string.h>
#include <stdint.h>
#include <stdbool.h>
static const char NAME_VOLTAGE[] = "Voltage";
static const char NAME_CURRENT[] = "Current";
static const char NAME_POWER[] = "Power";
static const char NAME_ENERGY[] = "Energy";
static const char NAME_UNKNOWN[] = "unknown";
static const char UNIT_VOLT[] = "V";
static const char UNIT_AMPERE[] = "A";
static const char UNIT_WATT[] = "W";
static const char UNIT_WATTHOUR[] = "Wh";
static const char UNIT_UNKNOWN[] = "?";
static parsedVIB_t parseVIB_FB(mbus_value_information_block vib) {
parsedVIB_t parsedVIB = { .name = NAME_UNKNOWN, .unit = UNIT_UNKNOWN, .exponent = 1, .found = false };
coloredMsg(LOG_RED, true, "mpe pvd_fb unknown vife 0x%02x", vib.vife[0]);
return parsedVIB;
}
static parsedVIB_t parseVIB_FD(mbus_value_information_block vib) {
parsedVIB_t parsedVIB = { .name = NAME_UNKNOWN, .unit = UNIT_UNKNOWN, .exponent = 1, .found = false };
if ((vib.vife[0] & 0b01110000) == 0b01000000) {
parsedVIB.name = NAME_VOLTAGE;
parsedVIB.unit = UNIT_VOLT;
parsedVIB.exponent = (vib.vife[0] & 0b01111) - 9;
parsedVIB.found = true;
} else if ((vib.vife[0] & 0b01110000) == 0b01010000) {
parsedVIB.name = NAME_CURRENT;
parsedVIB.unit = UNIT_AMPERE;
parsedVIB.exponent = (vib.vife[0] & 0b01111) - 12;
parsedVIB.found = true;
} else {
coloredMsg(LOG_RED, true, "mpe pvd_fd unknown vife 0x%02x", vib.vife[0]);
}
return parsedVIB;
}
static parsedVIB_t parseVIB_default(mbus_value_information_block vib) {
parsedVIB_t parsedVIB = { .name = NAME_UNKNOWN, .unit = UNIT_UNKNOWN, .exponent = 1, .found = false };
if ((vib.vif & 0b01111000) == 0b00000000) {
parsedVIB.name = NAME_ENERGY;
parsedVIB.unit = UNIT_WATTHOUR;
parsedVIB.exponent = (vib.vif & 0b0111) - 3;
parsedVIB.found = true;
} else if ((vib.vif & 0b01111000) == 0b00101000) {
parsedVIB.name = NAME_POWER;
parsedVIB.unit = UNIT_WATT;
parsedVIB.exponent = (vib.vif & 0b0111) - 3;
parsedVIB.found = true;
} else {
coloredMsg(LOG_RED, true, "mpe pvd unknown vif 0x%02x", vib.vif);
}
return parsedVIB;
}
parsedVIB_t parseVIB(mbus_value_information_block vib) {
parsedVIB_t parsedVIB;
if (vib.vif == 0xfb) {
parsedVIB = parseVIB_FB(vib);
} else if (vib.vif == 0xfd) {
parsedVIB = parseVIB_FD(vib);
} else {
parsedVIB = parseVIB_default(vib);
}
return parsedVIB;
}