|
|
|
|
@ -60,7 +60,6 @@ cCommandStream::CommandFn cmdGetScaleA;
|
|
|
|
|
cCommandStream::CommandFn cmdGetScaleB;
|
|
|
|
|
cCommandStream::CommandFn cmdCalibrateZeroScaleA;
|
|
|
|
|
cCommandStream::CommandFn cmdCalibrateZeroScaleB;
|
|
|
|
|
cCommandStream::CommandFn cmdCalibrateScales;
|
|
|
|
|
cCommandStream::CommandFn cmdCalibrateScaleA;
|
|
|
|
|
cCommandStream::CommandFn cmdCalibrateScaleB;
|
|
|
|
|
cCommandStream::CommandFn cmdSetDebugLevel;
|
|
|
|
|
@ -73,7 +72,6 @@ static const cCommandStream::cEntry sMyExtraCommmands[] =
|
|
|
|
|
{ "hello", cmdHello },
|
|
|
|
|
{ "get_calibration_settings", cmdGetCalibrationSettings },
|
|
|
|
|
{ "get_sensor_readings", cmdGetSensorReadings },
|
|
|
|
|
{ "calibrate_scales", cmdCalibrateScales },
|
|
|
|
|
{ "calibrate_zero_scale_a", cmdCalibrateZeroScaleA },
|
|
|
|
|
{ "calibrate_zero_scale_b", cmdCalibrateZeroScaleB },
|
|
|
|
|
{ "calibrate_scale_a", cmdCalibrateScaleA },
|
|
|
|
|
@ -101,7 +99,7 @@ sMyExtraCommands_top(
|
|
|
|
|
\****************************************************************************/
|
|
|
|
|
|
|
|
|
|
byte my_position = 0; // what is our actual measurement, starts with 0
|
|
|
|
|
unsigned long timer_pos0;
|
|
|
|
|
long timer_pos0;
|
|
|
|
|
|
|
|
|
|
// Global Variables
|
|
|
|
|
LORA_data lora_data;
|
|
|
|
|
@ -112,7 +110,6 @@ long iteration = 0; // what iteration number do we have, starts with 0
|
|
|
|
|
long package_counter = 0; // sent package counter
|
|
|
|
|
bool send_in_progress = false;
|
|
|
|
|
bool stop_iterations = false;
|
|
|
|
|
bool start_new_iteration = false;
|
|
|
|
|
bool next_package_is_init_package = true;
|
|
|
|
|
uint32_t gRebootMs;
|
|
|
|
|
|
|
|
|
|
@ -156,7 +153,7 @@ void setup(void)
|
|
|
|
|
|
|
|
|
|
setup_platform();
|
|
|
|
|
SetupScales(config_data.debug_level);
|
|
|
|
|
ClearLoraData(true);
|
|
|
|
|
ClearLoraData();
|
|
|
|
|
setup_bme280();
|
|
|
|
|
|
|
|
|
|
setup_flash();
|
|
|
|
|
@ -377,12 +374,9 @@ void setup_uplink(void)
|
|
|
|
|
void loop()
|
|
|
|
|
{
|
|
|
|
|
gCatena.poll();
|
|
|
|
|
if (start_new_iteration) {
|
|
|
|
|
StartNewIteration();
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void ClearLoraData(bool clearLastValues)
|
|
|
|
|
void ClearLoraData(void)
|
|
|
|
|
{
|
|
|
|
|
lora_data.version = LORA_DATA_VERSION;
|
|
|
|
|
lora_data.vbat = 0;
|
|
|
|
|
@ -412,15 +406,13 @@ void ClearLoraData(bool clearLastValues)
|
|
|
|
|
my_position = 0;
|
|
|
|
|
|
|
|
|
|
// We initialize last_sensor_reading
|
|
|
|
|
if (clearLastValues) {
|
|
|
|
|
last_sensor_reading.vbat = 0;
|
|
|
|
|
last_sensor_reading.weight1 = 0;
|
|
|
|
|
last_sensor_reading.weight2 = 0;
|
|
|
|
|
last_sensor_reading.weight = 0;
|
|
|
|
|
last_sensor_reading.temperature = 0;
|
|
|
|
|
last_sensor_reading.humidity = 0;
|
|
|
|
|
last_sensor_reading.pressure = 0;
|
|
|
|
|
}
|
|
|
|
|
last_sensor_reading.vbat = 0;
|
|
|
|
|
last_sensor_reading.weight1 = 0;
|
|
|
|
|
last_sensor_reading.weight2 = 0;
|
|
|
|
|
last_sensor_reading.weight = 0;
|
|
|
|
|
last_sensor_reading.temperature = 0;
|
|
|
|
|
last_sensor_reading.humidity = 0;
|
|
|
|
|
last_sensor_reading.pressure = 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void ShowLORAData(bool firstTime)
|
|
|
|
|
@ -506,7 +498,7 @@ uint8_t GetVBatValue(int millivolts)
|
|
|
|
|
void DoDeepSleep(uint32_t sleep_time)
|
|
|
|
|
{
|
|
|
|
|
if (config_data.debug_level > 0) {
|
|
|
|
|
gCatena.SafePrintf("DoDeepSleep, now going to deep sleep, millis: %d\n", millis());
|
|
|
|
|
gCatena.SafePrintf("DoDeepSleep, now going to deep sleep, millis: %d\n",millis());
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Prepare Deep Sleep
|
|
|
|
|
@ -523,19 +515,13 @@ void DoDeepSleep(uint32_t sleep_time)
|
|
|
|
|
deepSleepRecovery();
|
|
|
|
|
|
|
|
|
|
if (config_data.debug_level > 0) {
|
|
|
|
|
gCatena.SafePrintf("done with deep sleep, millis: %d\n", millis());
|
|
|
|
|
gCatena.SafePrintf("done with deep sleep, millis: %d\n",millis());
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Returns true if measurements are plausible, otherwise false
|
|
|
|
|
bool ReadSensors(SENSOR_data &sensor_data) {
|
|
|
|
|
bool plausible;
|
|
|
|
|
bool plausible_a;
|
|
|
|
|
bool plausible_b;
|
|
|
|
|
void ReadSensors(SENSOR_data &sensor_data) {
|
|
|
|
|
SENSOR_data res;
|
|
|
|
|
int32_t weight_current32;
|
|
|
|
|
int32_t weight_current32_a;
|
|
|
|
|
int32_t weight_current32_b;
|
|
|
|
|
long w1_0_real;
|
|
|
|
|
long w2_0_real;
|
|
|
|
|
|
|
|
|
|
@ -553,13 +539,29 @@ bool ReadSensors(SENSOR_data &sensor_data) {
|
|
|
|
|
if (config_data.debug_level > 0) {
|
|
|
|
|
gCatena.SafePrintf("LoadCell is ready.\n");
|
|
|
|
|
}
|
|
|
|
|
res.weight1 = (int32_t)ReadScale('A');
|
|
|
|
|
if (config_data.debug_level > 0) {
|
|
|
|
|
gCatena.SafePrintf("Load_cell 1 weight1_current: %ld\n", res.weight1);
|
|
|
|
|
if (config_data.cal_w1_0 != NOT_ATTACHED) {
|
|
|
|
|
res.weight1 = (int32_t)ReadScale('A');
|
|
|
|
|
if (config_data.debug_level > 0) {
|
|
|
|
|
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");
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
res.weight2 = (int32_t)ReadScale('B');
|
|
|
|
|
if (config_data.debug_level > 0) {
|
|
|
|
|
gCatena.SafePrintf("Load_cell 2 weight2_current: %ld\n", res.weight2);
|
|
|
|
|
if (config_data.cal_w2_0 != NOT_ATTACHED) {
|
|
|
|
|
res.weight2 = (int32_t)ReadScale('B');
|
|
|
|
|
if (config_data.debug_level > 0) {
|
|
|
|
|
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 {
|
|
|
|
|
@ -572,32 +574,18 @@ bool ReadSensors(SENSOR_data &sensor_data) {
|
|
|
|
|
PowerdownScale();
|
|
|
|
|
|
|
|
|
|
// Gewicht berechnen
|
|
|
|
|
weight_current32_a = (int32_t)((res.weight1 - w1_0_real) / config_data.cal_w1_factor);
|
|
|
|
|
weight_current32_b = (int32_t)((res.weight2 - w2_0_real) / config_data.cal_w2_factor);
|
|
|
|
|
weight_current32 = (int32_t)((weight_current32_a + weight_current32_b) / 5.0);
|
|
|
|
|
|
|
|
|
|
// we check if weights are plausible
|
|
|
|
|
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);
|
|
|
|
|
weight_current32 = (int32_t)((((res.weight1 - w1_0_real) / config_data.cal_w1_factor) + ((res.weight2 - w2_0_real) / config_data.cal_w2_factor)) / 5.0);
|
|
|
|
|
|
|
|
|
|
if (weight_current32 < 0) {
|
|
|
|
|
if (plausible) {
|
|
|
|
|
weight_current32 = 0;
|
|
|
|
|
}
|
|
|
|
|
weight_current32 = 0;
|
|
|
|
|
} else if (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...
|
|
|
|
|
weight_current32 = 0;
|
|
|
|
|
}
|
|
|
|
|
if (!plausible) {
|
|
|
|
|
weight_current32 = NOT_PLAUSIBLE_16;
|
|
|
|
|
if (!plausible_a) {
|
|
|
|
|
res.weight1 = NOT_PLAUSIBLE_32;
|
|
|
|
|
}
|
|
|
|
|
if (!plausible_b) {
|
|
|
|
|
res.weight2 = NOT_PLAUSIBLE_32;
|
|
|
|
|
}
|
|
|
|
|
if (config_data.cal_w1_0 == NOT_ATTACHED || config_data.cal_w2_0 == NOT_ATTACHED) {
|
|
|
|
|
// when at least one load cell is disabled, we multiply the measured weight by 2
|
|
|
|
|
weight_current32 = weight_current32 * 2;
|
|
|
|
|
}
|
|
|
|
|
res.weight = (uint16_t)weight_current32;
|
|
|
|
|
|
|
|
|
|
@ -625,11 +613,9 @@ bool ReadSensors(SENSOR_data &sensor_data) {
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
sensor_data = res;
|
|
|
|
|
return plausible;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void StartNewIteration() {
|
|
|
|
|
start_new_iteration = false;
|
|
|
|
|
uint32_t wait_time;
|
|
|
|
|
wait_time = 0;
|
|
|
|
|
|
|
|
|
|
@ -637,18 +623,7 @@ void StartNewIteration() {
|
|
|
|
|
iteration++;
|
|
|
|
|
|
|
|
|
|
SENSOR_data current_sensor_reading;
|
|
|
|
|
if (!ReadSensors(current_sensor_reading)) {
|
|
|
|
|
// we try a second time if Readings do not seem plausible
|
|
|
|
|
if (config_data.debug_level > 0) {
|
|
|
|
|
gCatena.SafePrintf("Readings do not seem plausible, try a second time\n");
|
|
|
|
|
}
|
|
|
|
|
delay(500);
|
|
|
|
|
if (!ReadSensors(current_sensor_reading)) {
|
|
|
|
|
if (config_data.debug_level > 0) {
|
|
|
|
|
gCatena.SafePrintf("Readings do not seem plausible for a second time, we give up!\n");
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
ReadSensors(current_sensor_reading);
|
|
|
|
|
int16_t temp_change;
|
|
|
|
|
|
|
|
|
|
// vBus
|
|
|
|
|
@ -697,27 +672,25 @@ void StartNewIteration() {
|
|
|
|
|
// we send data the first time the system is started, when the array is full
|
|
|
|
|
// or when the weight has fallen more than threshold or the first measurement is
|
|
|
|
|
// more than one hour old (which should not happen :-) )
|
|
|
|
|
bool big_difference = (abs(last_sensor_reading.weight - current_sensor_reading.weight) > SEND_DIFF_THRESHOLD_5GRAMS);
|
|
|
|
|
if ( (next_package_is_init_package) || (my_position >= MAX_VALUES_TO_SEND) || (big_difference) || ((millis() - timer_pos0) > 3600000)) {
|
|
|
|
|
if ( (next_package_is_init_package) || (my_position >= MAX_VALUES_TO_SEND) || (abs(last_sensor_reading.weight - current_sensor_reading.weight) > SEND_DIFF_THRESHOLD_5GRAMS) || ((millis() - timer_pos0) > 3600000)) {
|
|
|
|
|
lora_data.offset_last_reading = (uint8_t)((millis() - timer_pos0) / 1000 / 60);
|
|
|
|
|
if (config_data.debug_level > 0) {
|
|
|
|
|
gCatena.SafePrintf("startSendingUplink(), my_position: %d, iteration: %d, package_counter: %d, big_difference: %d\n", my_position, iteration, package_counter, big_difference);
|
|
|
|
|
gCatena.SafePrintf("startSendingUplink(), my_position: %d, iteration: %d, package_counter: %d\n", my_position, iteration, package_counter);
|
|
|
|
|
}
|
|
|
|
|
// the first <INIT_PACKETS> packets are "Init-Packets" or each INIT_PACKAGE_INTERVAL ...
|
|
|
|
|
// send confirmed if big_difference in weight
|
|
|
|
|
startSendingUplink(next_package_is_init_package, big_difference);
|
|
|
|
|
startSendingUplink(next_package_is_init_package);
|
|
|
|
|
next_package_is_init_package = ((iteration < INIT_PACKETS) || ((package_counter % INIT_PACKAGE_INTERVAL) == 0));
|
|
|
|
|
|
|
|
|
|
if (config_data.debug_level > 1) {
|
|
|
|
|
gLed.Set(LedPattern::TwoShort);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// Loop sending is in progress, timeout just in case after 600 seconds
|
|
|
|
|
unsigned long start_time = millis();
|
|
|
|
|
// Loop sending is in progress, timeout just in case after 300 seconds
|
|
|
|
|
long start_time = millis();
|
|
|
|
|
if (config_data.debug_level > 0) {
|
|
|
|
|
gCatena.SafePrintf("waiting while send is in progress\n");
|
|
|
|
|
}
|
|
|
|
|
while (send_in_progress && ((millis() - start_time) < 600000))
|
|
|
|
|
while (send_in_progress && ((millis() - start_time) < 300000))
|
|
|
|
|
{
|
|
|
|
|
gCatena.poll();
|
|
|
|
|
yield();
|
|
|
|
|
@ -747,9 +720,6 @@ void StartNewIteration() {
|
|
|
|
|
if (not(next_package_is_init_package)) {
|
|
|
|
|
// we make the current sensor reading to the last one...
|
|
|
|
|
last_sensor_reading = current_sensor_reading;
|
|
|
|
|
} else {
|
|
|
|
|
// we only copy the last weight
|
|
|
|
|
last_sensor_reading.weight = current_sensor_reading.weight;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
uint32_t sleep_time_sec;
|
|
|
|
|
@ -791,13 +761,13 @@ void StartNewIteration() {
|
|
|
|
|
if (config_data.debug_level > 0) {
|
|
|
|
|
gCatena.SafePrintf("LMIC.opmode just before Sleeping: %#x\n", LMIC.opmode);
|
|
|
|
|
gCatena.SafePrintf("LMIC.globalDutyRate: %d, LMIC.globalDutyAvail: %d, os_getTime: %d\n", LMIC.globalDutyRate, LMIC.globalDutyAvail, os_getTime());
|
|
|
|
|
gCatena.SafePrintf("LMIC.seqnoUp: %d, LMIC.seqnoDn: %d\n", LMIC.seqnoUp, LMIC.seqnoDn);
|
|
|
|
|
gCatena.SafePrintf("LMIC.seqnoUp: %d, LMIC.seqnoDn: %d\n",LMIC.seqnoUp, LMIC.seqnoDn);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (!fUsbPower && !stop_iterations) {
|
|
|
|
|
if (!fUsbPower) {
|
|
|
|
|
DoDeepSleep(sleep_time_sec);
|
|
|
|
|
if (! stop_iterations) {
|
|
|
|
|
start_new_iteration = true;
|
|
|
|
|
StartNewIteration();
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
}
|
|
|
|
|
@ -814,7 +784,7 @@ void StartNewIteration() {
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void startSendingUplink(bool firstTime, bool confirmed)
|
|
|
|
|
void startSendingUplink(bool firstTime)
|
|
|
|
|
{
|
|
|
|
|
send_in_progress = true;
|
|
|
|
|
|
|
|
|
|
@ -838,11 +808,6 @@ void startSendingUplink(bool firstTime, bool confirmed)
|
|
|
|
|
fConfirmed = true;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
// we can overwrite fConfirmed
|
|
|
|
|
if (confirmed) {
|
|
|
|
|
fConfirmed = true;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (firstTime) {
|
|
|
|
|
if (config_data.debug_level > 0) {
|
|
|
|
|
gCatena.SafePrintf("SendBuffer firstTime\n");
|
|
|
|
|
@ -852,19 +817,19 @@ void startSendingUplink(bool firstTime, bool confirmed)
|
|
|
|
|
if (config_data.debug_level > 0) {
|
|
|
|
|
gCatena.SafePrintf("LMIC.opmode just after SendBuffer (successful): %#x\n", LMIC.opmode);
|
|
|
|
|
gCatena.SafePrintf("LMIC.globalDutyRate: %d, LMIC.globalDutyAvail: %d, os_getTime: %d\n", LMIC.globalDutyRate, LMIC.globalDutyAvail, os_getTime());
|
|
|
|
|
gCatena.SafePrintf("LMIC.seqnoUp: %d, LMIC.seqnoDn: %d\n", LMIC.seqnoUp, LMIC.seqnoDn);
|
|
|
|
|
gCatena.SafePrintf("LMIC.seqnoUp: %d, LMIC.seqnoDn: %d\n",LMIC.seqnoUp, LMIC.seqnoDn);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
else {
|
|
|
|
|
gCatena.SafePrintf("LMIC.opmode just before SendBuffer (failed): %#x\n", LMIC.opmode);
|
|
|
|
|
gCatena.SafePrintf("LMIC.globalDutyRate: %d, LMIC.globalDutyAvail: %d, os_getTime: %d\n", LMIC.globalDutyRate, LMIC.globalDutyAvail, os_getTime());
|
|
|
|
|
gCatena.SafePrintf("LMIC.seqnoUp: %d, LMIC.seqnoDn: %d\n", LMIC.seqnoUp, LMIC.seqnoDn);
|
|
|
|
|
gCatena.SafePrintf("LMIC.seqnoUp: %d, LMIC.seqnoDn: %d\n",LMIC.seqnoUp, LMIC.seqnoDn);
|
|
|
|
|
}
|
|
|
|
|
} else {
|
|
|
|
|
if (config_data.debug_level > 0) {
|
|
|
|
|
gCatena.SafePrintf("LMIC.opmode just before SendBuffer: %#x\n", LMIC.opmode);
|
|
|
|
|
gCatena.SafePrintf("LMIC.globalDutyRate: %d, LMIC.globalDutyAvail: %d, os_getTime: %d\n", LMIC.globalDutyRate, LMIC.globalDutyAvail, os_getTime());
|
|
|
|
|
gCatena.SafePrintf("LMIC.seqnoUp: %d, LMIC.seqnoDn: %d\n", LMIC.seqnoUp, LMIC.seqnoDn);
|
|
|
|
|
gCatena.SafePrintf("LMIC.seqnoUp: %d, LMIC.seqnoDn: %d\n",LMIC.seqnoUp, LMIC.seqnoDn);
|
|
|
|
|
gCatena.SafePrintf("SendBuffer not firstTime\n");
|
|
|
|
|
}
|
|
|
|
|
if (gLoRaWAN.SendBuffer((uint8_t*)&lora_data, sizeof(LORA_data), sendBufferDoneCb, NULL, fConfirmed, kUplinkPort)) {
|
|
|
|
|
@ -872,16 +837,16 @@ void startSendingUplink(bool firstTime, bool confirmed)
|
|
|
|
|
if (config_data.debug_level > 0) {
|
|
|
|
|
gCatena.SafePrintf("LMIC.opmode just after SendBuffer (successful): %#x\n", LMIC.opmode);
|
|
|
|
|
gCatena.SafePrintf("LMIC.globalDutyRate: %d, LMIC.globalDutyAvail: %d, os_getTime: %d\n", LMIC.globalDutyRate, LMIC.globalDutyAvail, os_getTime());
|
|
|
|
|
gCatena.SafePrintf("LMIC.seqnoUp: %d, LMIC.seqnoDn: %d\n", LMIC.seqnoUp, LMIC.seqnoDn);
|
|
|
|
|
gCatena.SafePrintf("LMIC.seqnoUp: %d, LMIC.seqnoDn: %d\n",LMIC.seqnoUp, LMIC.seqnoDn);
|
|
|
|
|
}
|
|
|
|
|
} else {
|
|
|
|
|
gCatena.SafePrintf("LMIC.opmode just before SendBuffer (failed): %#x\n", LMIC.opmode);
|
|
|
|
|
gCatena.SafePrintf("LMIC.globalDutyRate: %d, LMIC.globalDutyAvail: %d, os_getTime: %d\n", LMIC.globalDutyRate, LMIC.globalDutyAvail, os_getTime());
|
|
|
|
|
gCatena.SafePrintf("LMIC.seqnoUp: %d, LMIC.seqnoDn: %d\n", LMIC.seqnoUp, LMIC.seqnoDn);
|
|
|
|
|
gCatena.SafePrintf("LMIC.seqnoUp: %d, LMIC.seqnoDn: %d\n",LMIC.seqnoUp, LMIC.seqnoDn);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
ClearLoraData(false);
|
|
|
|
|
ClearLoraData();
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void sendBufferDoneCb(
|
|
|
|
|
@ -943,7 +908,7 @@ void doSleepAlert(const bool fDeepSleep)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
for (int i = 0; i <= 15; i++) {
|
|
|
|
|
unsigned long prevPrint = millis();
|
|
|
|
|
long prevPrint = millis();
|
|
|
|
|
while (os_queryTimeCriticalJobs(ms2osticks(2000)) != 0)
|
|
|
|
|
{
|
|
|
|
|
gCatena.poll();
|
|
|
|
|
@ -1010,7 +975,7 @@ static void startNewIterationCb(osjob_t* pJob)
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (! stop_iterations) {
|
|
|
|
|
start_new_iteration = true;
|
|
|
|
|
StartNewIteration();
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
@ -1143,6 +1108,7 @@ cCommandStream::CommandStatus cmdHello(cCommandStream * pThis, void *pContext, i
|
|
|
|
|
return cCommandStream::CommandStatus::kSuccess;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
cCommandStream::CommandStatus cmdGetCalibrationSettings(cCommandStream * pThis, void *pContext, int argc, char **argv)
|
|
|
|
|
{
|
|
|
|
|
pThis->printf("{\n");
|
|
|
|
|
@ -1207,33 +1173,20 @@ cCommandStream::CommandStatus cmdCalibrateZeroScaleB(cCommandStream * pThis, voi
|
|
|
|
|
return cCommandStream::CommandStatus::kSuccess;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
cCommandStream::CommandStatus cmdCalibrateScales(cCommandStream * pThis, void *pContext, int argc, char **argv)
|
|
|
|
|
{
|
|
|
|
|
String s_cal_w1_0(argv[1]);
|
|
|
|
|
String s_cal_w1_factor(argv[2]);
|
|
|
|
|
String s_cal_w2_0(argv[3]);
|
|
|
|
|
String s_cal_w2_factor(argv[4]);
|
|
|
|
|
|
|
|
|
|
config_data.cal_w1_0 = s_cal_w1_0.toInt();
|
|
|
|
|
config_data.cal_w1_factor = s_cal_w1_factor.toFloat();
|
|
|
|
|
config_data.cal_w2_0 = s_cal_w2_0.toInt();
|
|
|
|
|
config_data.cal_w2_factor = s_cal_w2_factor.toFloat();
|
|
|
|
|
|
|
|
|
|
gCatena.getFram()->saveField(cFramStorage::kAppConf, (const uint8_t *)&config_data, sizeof(config_data));
|
|
|
|
|
|
|
|
|
|
pThis->printf("{ \"msg\": \"calibrate_scales was successful\" }\n");
|
|
|
|
|
|
|
|
|
|
return cCommandStream::CommandStatus::kSuccess;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
cCommandStream::CommandStatus cmdCalibrateScaleA(cCommandStream * pThis, void *pContext, int argc, char **argv)
|
|
|
|
|
{
|
|
|
|
|
String w1_gramm(argv[1]);
|
|
|
|
|
long weight1;
|
|
|
|
|
|
|
|
|
|
setup_scales();
|
|
|
|
|
weight1 = ReadScale('A');
|
|
|
|
|
config_data.cal_w1_factor = (float)((weight1 - config_data.cal_w1_0) / w1_gramm.toFloat());
|
|
|
|
|
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();
|
|
|
|
|
weight1 = ReadScale('A');
|
|
|
|
|
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));
|
|
|
|
|
|
|
|
|
|
@ -1247,9 +1200,15 @@ cCommandStream::CommandStatus cmdCalibrateScaleB(cCommandStream * pThis, void *p
|
|
|
|
|
String w2_gramm(argv[1]);
|
|
|
|
|
long weight2;
|
|
|
|
|
|
|
|
|
|
setup_scales();
|
|
|
|
|
weight2 = ReadScale('B');
|
|
|
|
|
config_data.cal_w2_factor = (float)((weight2 - config_data.cal_w2_0) / w2_gramm.toFloat());
|
|
|
|
|
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();
|
|
|
|
|
weight2 = ReadScale('B');
|
|
|
|
|
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));
|
|
|
|
|
|
|
|
|
|
|