fks function

Fast Kalman Smoother