PiP-X: Online feedback motion planning/replanning in dynamic environments using invariant funnels