Commented and added semi-functional uniform cost search