Moved additional params to getparams.m
Modified debug handling
Smooth leg velocity
Only consider a scan a discontinuity if its range is at least maxclasssize behind the object
Improved estimate of leg centers using avg(range)+diam/4 instead of min(range)+diam/2
Plot individual leg speeds
Minor bug