diff --git a/matlab/create_good_ordering.m~ b/matlab/create_good_ordering.m~ new file mode 100644 index 000000000..0dd4c020a --- /dev/null +++ b/matlab/create_good_ordering.m~ @@ -0,0 +1,16 @@ +% Christian Potthast +% create an elimination ordering + +function ord = create_good_ordering(n,m,measurements) + +ord = Ordering(); +landmark=1; +for pose=1:m + landmar + ord.push_back(sprintf('x%d',i)); + while (measurements{landmark}.i==pose) + ord.push_back(sprintf('m%d',j)); + landmark=landmark+1; + end + pose=pose+1; +end \ No newline at end of file