plausibility checks, eliminiate NOT_ATTACHED

This commit is contained in:
Joerg Lehmann 2020-07-01 13:11:56 +02:00
parent 90782229d5
commit cfaccfb14a
2 changed files with 40 additions and 58 deletions

View File

@ -530,6 +530,8 @@ void DoDeepSleep(uint32_t sleep_time)
// Returns true if measurements are plausible, otherwise false // Returns true if measurements are plausible, otherwise false
bool ReadSensors(SENSOR_data &sensor_data) { bool ReadSensors(SENSOR_data &sensor_data) {
bool plausible; bool plausible;
bool plausible_a;
bool plausible_b;
SENSOR_data res; SENSOR_data res;
int32_t weight_current32; int32_t weight_current32;
int32_t weight_current32_a; int32_t weight_current32_a;
@ -537,8 +539,6 @@ bool ReadSensors(SENSOR_data &sensor_data) {
long w1_0_real; long w1_0_real;
long w2_0_real; long w2_0_real;
plausible = true;
// vBat // vBat
int vbat_mv = (int)(gCatena.ReadVbat() * 1000.0f); int vbat_mv = (int)(gCatena.ReadVbat() * 1000.0f);
res.vbat = GetVBatValue(vbat_mv); res.vbat = GetVBatValue(vbat_mv);
@ -553,30 +553,14 @@ bool ReadSensors(SENSOR_data &sensor_data) {
if (config_data.debug_level > 0) { if (config_data.debug_level > 0) {
gCatena.SafePrintf("LoadCell is ready.\n"); gCatena.SafePrintf("LoadCell is ready.\n");
} }
if (config_data.cal_w1_0 != NOT_ATTACHED) {
res.weight1 = (int32_t)ReadScale('A'); res.weight1 = (int32_t)ReadScale('A');
if (config_data.debug_level > 0) { if (config_data.debug_level > 0) {
gCatena.SafePrintf("Load_cell 1 weight1_current: %ld\n", res.weight1); gCatena.SafePrintf("Load_cell 1 weight1_current: %ld\n", res.weight1);
} }
} else {
res.weight1 = 0;
w1_0_real = 0;
if (config_data.debug_level > 0) {
gCatena.SafePrintf("Load_cell 1 is disabled\n");
}
}
if (config_data.cal_w2_0 != NOT_ATTACHED) {
res.weight2 = (int32_t)ReadScale('B'); res.weight2 = (int32_t)ReadScale('B');
if (config_data.debug_level > 0) { if (config_data.debug_level > 0) {
gCatena.SafePrintf("Load_cell 2 weight2_current: %ld\n", res.weight2); gCatena.SafePrintf("Load_cell 2 weight2_current: %ld\n", res.weight2);
} }
} else {
res.weight2 = 0;
w2_0_real = 0;
if (config_data.debug_level > 0) {
gCatena.SafePrintf("Load_cell 2 is disabled\n");
}
}
} }
else { else {
if (config_data.debug_level > 0) { if (config_data.debug_level > 0) {
@ -593,22 +577,31 @@ bool ReadSensors(SENSOR_data &sensor_data) {
weight_current32 = (int32_t)((weight_current32_a + weight_current32_b) / 5.0); weight_current32 = (int32_t)((weight_current32_a + weight_current32_b) / 5.0);
// we check if weights are plausible // we check if weights are plausible
plausible = (weight_current32_a > -10000) && (weight_current32_b > -10000) && (weight_current32_a < 150000) && (weight_current32_b < 150000); plausible_a = (weight_current32_a > -10000) && (weight_current32_a < 150000);
plausible_b = (weight_current32_b > -10000) && (weight_current32_b < 150000);
plausible = (plausible_a && plausible_b);
if (weight_current32 < 0) { if (weight_current32 < 0) {
if (plausible) {
weight_current32 = 0; weight_current32 = 0;
} else if (weight_current32 > UINT16_MAX) { }
} else if (weight_current32 > UINT16_MAX) {
//weight_current32 = UINT16_MAX; //weight_current32 = UINT16_MAX;
// we set the weight to 0, as such high values are not realistic and probably a sign for bad calibration... // we set the weight to 0, as such high values are not realistic and probably a sign for bad calibration...
weight_current32 = 0; weight_current32 = 0;
} }
if (config_data.cal_w1_0 == NOT_ATTACHED || config_data.cal_w2_0 == NOT_ATTACHED) { if (!plausible) {
// when at least one load cell is disabled, we multiply the measured weight by 2 weight_current32 = NOT_PLAUSIBLE_16;
weight_current32 = weight_current32 * 2; if (!plausible_a) {
} res.weight1 = NOT_PLAUSIBLE_32;
res.weight = (uint16_t)weight_current32; }
if (!plausible_b) {
res.weight2 = NOT_PLAUSIBLE_32;
}
}
res.weight = (uint16_t)weight_current32;
if (fBme) { if (fBme) {
/* warm up the BME280 by discarding a measurement */ /* warm up the BME280 by discarding a measurement */
(void)gBME280.readTemperature(); (void)gBME280.readTemperature();
@ -1238,15 +1231,9 @@ cCommandStream::CommandStatus cmdCalibrateScaleA(cCommandStream * pThis, void *p
String w1_gramm(argv[1]); String w1_gramm(argv[1]);
long weight1; long weight1;
if (w1_gramm == "NA") {
// scale a is not connected
config_data.cal_w1_factor = 1.0;
config_data.cal_w1_0 = NOT_ATTACHED;
} else {
setup_scales(); setup_scales();
weight1 = ReadScale('A'); weight1 = ReadScale('A');
config_data.cal_w1_factor = (float)((weight1 - config_data.cal_w1_0) / w1_gramm.toFloat()); config_data.cal_w1_factor = (float)((weight1 - config_data.cal_w1_0) / w1_gramm.toFloat());
}
gCatena.getFram()->saveField(cFramStorage::kAppConf, (const uint8_t *)&config_data, sizeof(config_data)); gCatena.getFram()->saveField(cFramStorage::kAppConf, (const uint8_t *)&config_data, sizeof(config_data));
@ -1260,15 +1247,9 @@ cCommandStream::CommandStatus cmdCalibrateScaleB(cCommandStream * pThis, void *p
String w2_gramm(argv[1]); String w2_gramm(argv[1]);
long weight2; long weight2;
if (w2_gramm == "NA") {
// scale b is not connected
config_data.cal_w2_factor = 1.0;
config_data.cal_w2_0 = NOT_ATTACHED;
} else {
setup_scales(); setup_scales();
weight2 = ReadScale('B'); weight2 = ReadScale('B');
config_data.cal_w2_factor = (float)((weight2 - config_data.cal_w2_0) / w2_gramm.toFloat()); config_data.cal_w2_factor = (float)((weight2 - config_data.cal_w2_0) / w2_gramm.toFloat());
}
gCatena.getFram()->saveField(cFramStorage::kAppConf, (const uint8_t *)&config_data, sizeof(config_data)); gCatena.getFram()->saveField(cFramStorage::kAppConf, (const uint8_t *)&config_data, sizeof(config_data));

View File

@ -65,7 +65,8 @@ static const uint8_t LORA_DATA_VERSION = 1;
static const uint8_t LORA_DATA_VERSION_FIRST_PACKAGE = 128; static const uint8_t LORA_DATA_VERSION_FIRST_PACKAGE = 128;
static const uint32_t PRESSURE_OFFSET = 825; static const uint32_t PRESSURE_OFFSET = 825;
static const uint16_t SEND_DIFF_THRESHOLD_5GRAMS = 20; // when weight changes by 100g, then send data static const uint16_t SEND_DIFF_THRESHOLD_5GRAMS = 20; // when weight changes by 100g, then send data
static const long NOT_ATTACHED = -2147483648; static const long NOT_PLAUSIBLE_16 = 65535;
static const long NOT_PLAUSIBLE_32 = 2147483647;
static const byte INIT_PACKETS = 5; static const byte INIT_PACKETS = 5;
// must be 64 bytes long (size of kAppConf) // must be 64 bytes long (size of kAppConf)