Created an Anytime SBA* algorithm. Seems good, needs some tweeking for the post-solution iterations.