fixed more in state
Fixed search between point and goal.