Continue work on arbitrary-class HEAP
Add gsp.cpp, gsp.h: implementation of ShortestPath