create a temporal order
parent
e9d942f81e
commit
b67d2ae5f7
|
@ -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
|
Loading…
Reference in New Issue