Try this...

FILTER CON 16 'CHANGE THIS VARIABLE TO VARY FILTER RESPONCE
PASVAR VAR WORD 'USED FOR FILTER HISTORY
INVAR VAR WORD 'INPUT VARIABLE
OUTVAR VAR WORD 'FILTERED OUTPUT VARIABLE

' ************************************************** ******************
LOWPASS: 'LOW PASS FILTER (256 = NO FILTER ACTION/ 1 = MAXIMUM FILTER ACTION)
' ************************************************** ******************
PASTVAR = (PASTVAR - (PASTVAR */ FILTER)) + INVAR
OUTVAR = PASTVAR */ FILTER 'FINAL DRIVE OUTPUT COMPUTED
RETURN