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
|