HW1
Working new uniform cost search