Steady-State Filter

Input Parameters: x0 - Initial state vector smoocof - Ideal smoothing coefficient inp - Position measurement array npts - Number of points in input positions T - Sampling interval nvar - Ideal noise variance Output Parameters: residual - Position error array (residuals) estimate - Predicted position array