rubengooj / stvo-pl

Stereo Visual Odometry by combining point and line segment features
GNU General Public License v3.0
222 stars 96 forks source link

How to calculate the uncertainty of the projection error? #11

Open liusilin40 opened 6 years ago

liusilin40 commented 6 years ago

hello, your paper about probabilistic combination of points and line features inspire me very much. but while I read the paper, I got confused about how to calculate the weight of cost function, in paper the equation is: image According to my understanding, image is the jacobians to the observatons, so for point feature, the jacobians is: image as for line segment feature, I get an strange 3*2 matrix, but it's not compatible with equations(3). I must mistake something. but I can't get any inspiration from your commented "StereoFrameHandler::optimizeFunctions_uncweighted()" function. can you show how to derive it?