Fixed bug in DP where updatednodecost for goal and unconnected nodes wasnt being explicitly set to old values