Reactive Integrated Motion Planning and Execution