Search

Needs work to be compatible with other methods, only works if obstacles do not need moving.