add matlab codes and doc for nonlinear filtering