Added option for arrival cost computations in MHE.