Incremental Generalized Hybrid A*