12345qiupeng
/
gtsam
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

fix the plot_projected_landmarks.m project_landmarks.m

release/4.3a0
lvzhaoyang 2014-12-07 00:31:48 -05:00
parent fa4bfbfbc5
commit 2371600c63
2 changed files with 2 additions and 2 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
matlab/unstable_examples/plot_projected_landmarks.m
View File

@ -23,7 +23,7 @@ z = zeros(1,nrMeasurements);
for i = 0:measurement_keys.size-1 for i = 0:measurement_keys.size-1
key = measurement_keys.at(i); key = measurement_keys.at(i);
key_index = gtsam.symbolIndex(key); key_index = gtsam.symbolIndex(key);
p = landmarks.at(gtsam.symbol('l',key_index)); p = landmarks.atPoint3(gtsam.symbol('l',key_index));
x(i+1) = p.x; x(i+1) = p.x;
y(i+1) = p.y; y(i+1) = p.y;

2
matlab/unstable_examples/project_landmarks.m
View File

@ -8,7 +8,7 @@ function [ measurements ] = project_landmarks( pose, landmarks, K )
measurements = Values; measurements = Values;
for i=1:size(landmarks)-1 for i=1:size(landmarks)-1
z = camera.project(landmarks.at(symbol('l',i))); z = camera.project(landmarks.atPoint3(symbol('l',i)));
% check bounding box % check bounding box
if z.x < 0 || z.x > 1280 if z.x < 0 || z.x > 1280