add psp planner
[psp] implement simple backward search