Added size(), empty(), push() instead of insert()
Added shortest path stuff