Fixed heap
Fixing search
Finished testing search algo