diff --git a/ptxdist/local_src/ecu01-codesys/io_driver/ecu01compcap.cpp b/ptxdist/local_src/ecu01-codesys/io_driver/ecu01compcap.cpp index 552e8c0..6391612 100644 --- a/ptxdist/local_src/ecu01-codesys/io_driver/ecu01compcap.cpp +++ b/ptxdist/local_src/ecu01-codesys/io_driver/ecu01compcap.cpp @@ -133,10 +133,15 @@ void Ecu01CompCap::cycle() _refError = ioc.RefError; _isrTolerCnt = ioc.IsrTolerCnt; +#if 1 + _isrMaxDelay = (ioc.IsrMaxDelay*100L)/665; + _isrAvgDelay = (ioc.IsrAvgDelay*100L)/665; + _isrDelayCov = (ioc.IsrDelayCov*100L)/665; +#else _isrMaxDelay = ioc.IsrMaxDelay; _isrAvgDelay = ioc.IsrAvgDelay; _isrDelayCov = ioc.IsrDelayCov; - +#endif } diff --git a/ptxdist/local_src/ecu01-comp-cap/mmc_imp.c b/ptxdist/local_src/ecu01-comp-cap/mmc_imp.c index 5edb6d2..34297a5 100644 --- a/ptxdist/local_src/ecu01-comp-cap/mmc_imp.c +++ b/ptxdist/local_src/ecu01-comp-cap/mmc_imp.c @@ -90,35 +90,30 @@ int GetPhaseShift(const unsigned int * restrict ref, const unsigned int * restri halfperiod = periode / 2; - /* loop i over a maximum of 32 ref values. */ + /* loop i over a maximum of 32 shift values. */ for (i=0, j=0 ; i= 0) && (diff < halfperiod)) { - /* valid pair found */ - sum += diff; - cnt++; + if (diff >= 0) { + if (diff < halfperiod) { + /* valid pair found */ + sum += diff; + cnt++; + // ?? j++; + } else { + /* valid pair cannot be found for this i */ + } + break; /* exit loop -> next i */ } } /* end for j */