Add Piority queues
- added heap-based priority queue
- added heap-based indexed priority queue
- Cosmetic changes to remove some warnings
- Some Javadoc fixes