ICS: Incremental Constrained Smoothing for State Estimation | IEEE Conference Publication | IEEE Xplore