FS: Detect runout earlier

This commit is contained in:
Yuri D'Elia 2019-06-01 22:06:55 +02:00
parent 4774b44e21
commit e8ce5e140e
1 changed files with 2 additions and 5 deletions

View File

@ -19,7 +19,7 @@
//! @name Basic parameters //! @name Basic parameters
//! @{ //! @{
#define FSENSOR_CHUNK_LEN 0.64F //!< filament sensor chunk length 0.64mm #define FSENSOR_CHUNK_LEN 0.64F //!< filament sensor chunk length 0.64mm
#define FSENSOR_ERR_MAX 17 //!< filament sensor maximum error count for runout detection #define FSENSOR_ERR_MAX 9 //!< filament sensor maximum error count for runout detection
//! @} //! @}
//! @name Optical quality measurement parameters //! @name Optical quality measurement parameters
@ -453,10 +453,7 @@ ISR(FSENSOR_INT_PIN_VECT)
{ {
if (pat9125_y < 0) if (pat9125_y < 0)
{ {
if (fsensor_err_cnt) fsensor_err_cnt++;
fsensor_err_cnt += 2;
else
fsensor_err_cnt++;
} }
else if (pat9125_y > 0) else if (pat9125_y > 0)
{ {