Move Stack, MinPQ and Queue to datastructures package.
Add code to implement animation of solution (not working 100% yet).