I've takan all the input parameters, and the very first thing is I've set the dimension of the matrix and the vector: the length of the Path, plus the number of Landmarks-- times 2--because I'm modeling x and y for each of those, in the same data structures. 