https://github.com/RomaTeng/EKF-SLAM-on-Manifold
Revision f32259f3994a80ae6693c8b1f6f367fc04bd44fc authored by Kanzhi Wu on 27 June 2016, 12:45:06 UTC, committed by Kanzhi Wu on 27 June 2016, 12:45:06 UTC
1 parent f19c491
Raw File
Tip revision: f32259f3994a80ae6693c8b1f6f367fc04bd44fc authored by Kanzhi Wu on 27 June 2016, 12:45:06 UTC
update, not finished yet, do no modify, test rms and nees under multiple runs
Tip revision: f32259f
StereoProjection.m
function y=StereoProjection(Pose,landmark)

R=Pose(1:3,1:3);
P=Pose(1:3,4);

Local=R'*(landmark-P);

K=[];

ur=12;
ul=11;
v=3;




y=[Local' Local'];


end
back to top