Bahnplanung mit matlabhnplanung

ich beschäftige mich mit bahnplanung (mit matlab)
ich muss den uniform cost search algorithmus mit matlab programmieren,damit ich ein kürztes weg von start bis zum ziel ohne mit hindernissen zu stossen,
meine frage ist wie kann ich das programmieren, ich anfänger von matlab,
mit freundlichen grüssen