Started adding unittesting for shortest distance path