Changed Speed Filter
 / Speed Filter now used mean and variance