Added leJOS compatible code

I added leJOS compatible code for our search, meaning that we can now
calculate the search on the robot directly ourselves!! I had to use a
special implementation of Deque, however the code should still work
correctly.