RHKF Filter / Smoother for Nonlinear Systems