not sure whether loops should be T_MPC or T in slam-state-mpc. committing and switching to T