Add uniform cost search(v0.1) and print out path cost/ num of nodes expanded/ max frontier