UniformCostSearch implemented!

Tests needed for it still tho