Adding unit test section for checking nodes/edges correctness. Adding Iing INITIAL_CAPACIs.
Managing const-correctness. Minor updates in unit test.