with the number n of correspondences used. This pro-
hibits an application in real-time reactive systems. We
present the results of these experiments in detail in
section 4.
3 NEW APPROACH
To overcome the problems of BlindPnPC, we de-
veloped an algorithm called PPnP which utilizes the
prior probability similar to BlindPnPC in order to ef-
fectively reduce the search space of the correspon-
dence problem.
3.1 Idea
Similar to BlindPnPC, in PPnP consecutively a num-
ber of correspondences which are valid with respect to
the prior probability are hypothesized using a Kalman
filter. Thereby the camera pose evolves from its initial
position.
BlindPnPC. Problematic in BlindPnPC is that each
consecutively selected correspondence has to be valid
in order to converge towards the real pose. If once
in BlindPnPC a wrong hypothesis is made, the pose
evolves in a bad way because future hypotheses cho-
sen will be outliers with a higher probability.
Hypothesizing an outlier will always badly affect
the current pose estimation Q. When projecting the
3D points P
i
and constructing the image projection
covariance Σ
i
Q
, many inliers previously correctly clas-
sified will now be marked as outliers and thereby not
be considered in the next selection process. Addition-
ally, by badly evolving the pose, outliers can now be-
come compatible with the current pose prior proba-
bility and are therefore treated as hypothetical inliers.
Combined, these effects lead to an increased outlier
ratio for the hypothesizing possibilities in the next
selection process. Thereby an outlier is also chosen
in the next selection process with a higher probabil-
ity, evolving Q even worse. BlindPnPC tries to solve
this issue by recursively hypothesizing all arguable
sequences of compatible correspondences containing
only three elements and selecting the one with the
least error function value. Thus a very large number
of consecutive hypotheses has to be made.
PPnP. PPnP tries to solve this issue by using a dif-
ferent approach: Consecutively a number of c corre-
spondences are hypothesized. Similar to BlindPnPC,
hypothesizing a correspondence P
i
←→ p
i
is realized
using a Kalman filter. Different than in BlindPnPC,
c is usually a number much higher than three. While
in BlindPnPC the whole sequence of hypotheses has
to be free of outliers, this is not a necessary condi-
tion for PPnP: At each step, all hypothesizing pos-
sibilities are stored for future use along with the un-
certainty information Σ
i
Q
and J
i
Q
. When it comes to
selecting a new hypothesizing candidate, it is ran-
domly selected from all available hypothesizing pos-
sibilities (containing also the ones not hypothesized in
the past). The key point is, that once an outlier is hy-
pothesized, the number m
i
of compatible candidates
when just considering the actual pose probability at
hypothesizing step i is relatively small compared to
the number of all hypothesizing possibilities from the
previous steps m
old
def
=
∑
i−1
j=0
m
j
. Since in the past a se-
quence of correct hypotheses was made, the majority
of all previous hypothesizing possibilities will contain
correctly identified inliers. Since the new hypothesis
is randomly chosen among all those m
new
def
= m
old
+m
i
possibilities with approximately m
old
correct hypoth-
esizing possibilities and only approximately m
i
out-
liers misleadingly classified as inliers, a correct cor-
respondence is selected with a relatively high prob-
ability. Hence, if an outlier is hypothesized at step
i, PPnP selects with a high probability an inlier for
the next candidate and thereby pushes the wrongly
evolved pose back to a valid state.
To gain a similar precision as RANSAC+EPnP,
the final camera pose estimate is only used in order
to classify M
Q
and F
Q
. M
Q
is then used in order to
calculate a high precision solution using EPnP.
Combined, this allows evolving the pose from a
relatively small fixed number of hypothesizing se-
quences containing c correspondences, instead of
considering each permutation combination of three
correspondences.
3.2 Optimization
Accelerating the Hypothesizing Process. Before
a correspondence from all available possibilities is
randomly selected for hypothesizing, all correspon-
dences are checked for validity with the current pose
prior probability. The information of each compat-
ible correspondence is then added to the set of se-
lectable options. If the number of correspondences
grows, the procedure of testing each correspondence
at each step for validity may lead to large overhead.
Fortunately this procedure can be optimized: A cor-
respondence being invalid with the pose prior proba-
bility at step i is unlikely to become valid in later steps
i + 1, i + 2, . . . because the overall reprojection uncer-
tainty reduces. This way, one can skip the successive
testing for validity of a certain correspondence, once
REAL-TIME CAMERA POSE ESTIMATION USING CORRESPONDENCES WITH HIGH OUTLIER RATIOS -
Solving the Perspective n-Point Problem using Prior Probability
383