Select planner on runtime
Update test app
Temporary fixes: Default planner added, cleanup removed
Add error_code to to MotionPlanResponse