3DPrinting/Prusa-Firmware
1
0
Fork 0
Code Issues Pull requests Projects Releases Packages Wiki Activity

FS: Trigger a runout with repeated soft-failures (clog?)

Browse source
This commit is contained in:
Yuri D'Elia 2019-06-03 17:31:19 +02:00
parent 8fb8ff4bf4
commit ce74b746f1
1 changed files with 21 additions and 7 deletions
Show stats Download patch file Download diff file Expand all files Collapse all files

16
Firmware/fsensor.cpp
View file

@ -20,6 +20,9 @@
//! @{
#define FSENSOR_CHUNK_LEN 0.64F //!< filament sensor chunk length 0.64mm
#define FSENSOR_ERR_MAX 9 //!< filament sensor maximum error count for runout detection
#define FSENSOR_SOFTERR_CMAX 3 //!< number of contiguous soft failures before a triggering a runout
#define FSENSOR_SOFTERR_DELTA 30000 //!< maximum interval (ms) to consider soft failures contiguous
//! @}
//! @name Optical quality measurement parameters
@ -85,6 +88,8 @@ uint32_t fsensor_autoload_last_millis;
uint8_t fsensor_autoload_sum;
//
uint8_t fsensor_softfail = 0;
uint8_t fsensor_softfail_ccnt = 0;
unsigned long fsensor_softfail_last = 0;
//! @}
@ -599,14 +604,23 @@ void fsensor_update(void)
fsensor_autoload_enabled = autoload_enabled_tmp;
fsensor_oq_meassure_enabled = oq_meassure_enabled_tmp;
if (!err)
unsigned long now = _millis();
if (!err && (now - fsensor_softfail_last) > FSENSOR_SOFTERR_DELTA)
fsensor_softfail_ccnt = 0;
if (!err && fsensor_softfail_ccnt <= FSENSOR_SOFTERR_CMAX)
{
printf_P(PSTR("fsensor_err_cnt = 0\n"));
++fsensor_softfail;
++fsensor_softfail_ccnt;
fsensor_softfail_last = now;
}
else
{
fsensor_softfail_ccnt = 0;
fsensor_softfail_last = 0;
fsensor_enque_M600();
}
}
#else //PAT9125
if (CHECK_FSENSOR && ir_sensor_detected)
{