A general iterative extended kalman filter framework for state estimation on matrix lie groups