16 lines
343 B
Matlab
16 lines
343 B
Matlab
% 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 |