improved stability for slam case