* Update PeakFindingProblem code to allow diagonal motion

* Fix unit test issues

* update PeakFindingProblem to take actions as input param

* Refactor code in search.py