Changes:
 1) Fixed bug in HADIStage1
 2) Added code for testing the accuracy of algorithm for a sample graph