Bug fixes to priority queue
Bug fixes to priority queue

Fixed issues that may have caused stack overflow exceptions to be thrown for very large queues. Fixed toString() method which was broken after last update. Further improvements made to optimisation - mainly space complexity. 

Updated Doxygen documentation for several methods, including searchByPriority and operator>>
philj56/robot-swing,philj56/robot-swing,philj56/robot-swing