Optimization Based Kalman Filters

It’s all in the link I posted, in particular the PR title