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