|
|
@ -394,6 +394,7 @@ pitchfn1 = GetPitchMeasurement()-pitchfn; |
|
|
|
|
|
|
|
|
|
|
|
pitchXn2=pitchXn1-((pitchXn1-pitchXn0)*pitchfn1)/(pitchfn1-pitchfn0); // new DAC value
|
|
|
|
pitchXn2=pitchXn1-((pitchXn1-pitchXn0)*pitchfn1)/(pitchfn1-pitchfn0); // new DAC value
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
delay(100); |
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
pitchXn0 = pitchXn1; |
|
|
|
pitchXn0 = pitchXn1; |
|
|
@ -458,7 +459,7 @@ volumefn1 = GetVolumeMeasurement()-volumefn; |
|
|
|
|
|
|
|
|
|
|
|
volumeXn2=volumeXn1-((volumeXn1-volumeXn0)*volumefn1)/(volumefn1-volumefn0); // calculate new DAC value
|
|
|
|
volumeXn2=volumeXn1-((volumeXn1-volumeXn0)*volumefn1)/(volumefn1-volumefn0); // calculate new DAC value
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
delay_NOP(44316);//44316=100ms
|
|
|
|
|
|
|
|
|
|
|
|
volumeXn0 = volumeXn1; |
|
|
|
volumeXn0 = volumeXn1; |
|
|
|
volumeXn1 = volumeXn2; |
|
|
|
volumeXn1 = volumeXn2; |
|
|
|