particle filtering context. In marker-based systems, the markers positions in each camera's image plan give us the real 3D positions of the markers. In some.
&! * (#+, !-( ! "# $% &! $ ' !( )!
#
$, !-(
.
! "# $% &! $ .' !( )!
"
! " #
! $ . #. ( # #, / ., . ) # , $ ., )(!#. $ # ) $$( . !. (.% 0 ., !% /,($, ! # !% # !( #-! ( - - .( /(., 0! /( 0 0 !0 1 #. ) ., ) # $$ ! !( 0 / 2( 0 3, ( ) !#. % (#. -! - # ., 0% . $, 0% . . $. . $% . / ! # ., ) )# ( !# # ! ( 0 ., (! !% % $.( (.( # . , 4 (. - ! . !#/ . . $$ . % ($ $ ( ($ . ! 3, !(0( (.% ) ! --! $,( -($ . # %$ #.!( .# . ., ., # . $, 0( # # $. % ., # ( ! ( ( 0 (! . #, . . ! / ! # # !# /( .. $, . ., % ! #%#. #. $) .( 0 ., $ . .($ % /(., . % , ( . ! .( ., ., !, # # # !##, / $ #. ., # $ (.( # #( 0 ( ) ## #. ., #. 5 . --! $, . # ! 0 (. - ! . !# .,(# - - !/ /( -!# . / ., . .!$2 % 6 .( /,($,!#- $.#., -!( $(- # ) ! --! $,
( -., 0 (. %#(#!5 (!#., 2 / 0 ) . !%#- .( . - ! - ! . !## $, #/ 2( 0 #,(2 0 # #.!( 0., /( ., .( )# -- !. 0 ., !# ! !. . ( .,(# ( ) ! .( 6, .( $ -. ! #%#. , #. - 1 !2 ! # #%#. # 789 , /( % # ) ! % !# /(., --($ .( # ) ( ( .!($# .%-($ #%#. # ! )!) $.( !2 !# ! .. $, . # ! 2 % - ( .# ) ., - .( .:# % ., $ -. ! % ( )!! $ !# )(; . 2 / - #(.( #( ., ) . 0 (! . 3, !2 !# - #(.( # ! ., .! #) ! ( . 6 - #(.( # #( 0 .!( 0 .( )! ., # ! $ !# ) # 2( 0 (. ( - ##( . .!$2 - ( .:# .( /, (. (# . (#( % ./ ! ! $ !# < / ! #( 0 !2 !#$ $ #( ! .! #( . # ( -($ . # ., # ) ;- #( #- $( (= 5 (- . !5 (!# ) . 0 . 2 ( #- $( % !! 0 (! . >#( 0 ( ) # )! $ .( $ !# /(., . ., # )#- $( , ! / ! ( -($ . #., - . ) !2 ! ## % .( $ -. ! #%#. # !$, ( .,(# ( (#0 ! % # ., !.($ . # --! $, < !(. 0 . 7 9 -!# . ))($( . #%#. $) .!$2( 0 6 % .( #( 0 #( 0 $ ! 3,(# (0,. # ( % --($ .( # < / !(. (# . -! ( 6 - #(.( # !#.!($.( 0 ., ( ) ! .( / $ ;.!$. )! ., ) # !0 ! . 7 9 # 0! ( . #$ . # !$, /(., )! . )! !0( # .$,( 0 --( .,(# ., #, !. .( $ ! # 5 $ # 3,(# ., -! . . .!$2 0( .( # /(., $ .. ! $20! # ., ., !, $ .( 0 %- !.# % .$,( 0( 0 !0( # !(#2#. -! $ !(). ( 0 #5 $ # + ( ( 0 6 .!$2 ! ! 6 $ )(0 !.( #< / . 7 9 /! . -! $ 6 %- # )! #, !. #( 0 $ ! ) # 4 !( 6 (# 7 9 # ;-($(. ,( !!$,($ # !$, ( /,($, ., % # 5 .( % $ . - !.# )., %? # $, ( @ 0 . !# ) / % -- !
! /! ! ., , A ! $( 0 ., # !$, $ - ;(.% #(0 ()($ . % ! / ! #(. .( # (. # #. , ! . #- $()% $, %- !. ( ., ( 0 ( . % /(., . #( 0 # !$ !$ # ( , . 7 9 # + # .( 0 !(., 7B9 /(., ! #. $, #.($ # 0 !.( ) ( 0 ) ! .( . .!$2 ) % .( 3, !0 ! )- !.($ # # 2 # .,(# 0 !(., ! # /%+ , . 7C9 .!( . ! $ ., ! ) - !.($ # #( 0 -- !. $. ! 1 $,( . .!( % # < / ! #( 0 % ($ #/ !#.!($. ., 0 ! (.% )., --! $, -! . ., #%#. )! .!$2( 0 0 (. ! (.( # >#( 0 .(- $ !# ) # . )! #D# $ -. ! 6 .#$, ! . 7 9 -! $ ., #. 2 / !# .#. . ( 6 ) % .!$2( 0 3, (! --! $, / # # / 2 % ($ ( 0 /,($, (# $ - ; ()( + # .( 0 !(., )$. .( %! - !.($ # #. $, #.($# !$, 0 !(., / # --( . ! $ ., ! )- !.($ # 3,(# 0 !(., # # $ .( .( -!( $(- . ( .! $ ., ( ) $ ) !! / - 2# ( ., ) $.( 0! % --%( 0.,(#.%- ) % ! # !$, 0 .#., !(#2# )) ( 0( . $ ( ( #- $( %( ., $ # ) / !)!5 $% $ -. ! ( . -! . ! $ ., .( $ - ;(.%( #(0 ()($ . / % 1 #. ) ., # ., # / ! !(0( % # ) !$, !$. ! ( .( . . ., !5 (! .# ) !#. % )$. / . ;.!$. ., ; $. 6 - #(.( )# ! - ( .# )., , % ( ! !. . $. 0 (. ! (.( # #( 0 $ .( (0(. $ ! ) #@ )! #D#A % #- $.( 0 ., # $ (.( #!5 (!#$ $ ( ( 0 / #( - 0 !(., 3, ., / -!# . , ! (# # #( ()( - !.($ )( . !( 0 0 !(., /,($, / $ ! $ !% 0 ) !0! # 0 . .( 6 !.($ . % ( 0 ! #($ .# ( ! --! $, 3, !.($ . ., (2 (, ) $.( / # /( #$!( ( $.( # ! ( / ) - !.($ )( . !#/( ;- # ( $.( # $.( / -!# . ., ! 0 !(., !# .#/( #, / ( $.( B
#$
%
#( #. ) % .!$2( 0 --! $, # !.($ . % / # # 3,(# (#) ! % 8 - ( .# !E( .#., . !-!# . 2 % - ( .# )., , %@, /# # $! 2 # 2 # .$A 8B !(0( # 0 .#., E( -., # - ( .# F $,- ( . (#0( ! ) 0! # ))! @ ;( A !-!# .( 0., ! . .( # . 6 ; #@; % =A
3, # 0! # ) )! #, #( . --! ;( . % ., / % ., , % - !.# ! (# - ! . !(# /(., 8 0! # ) )! 3,(##2 . (#., ) #, .( / %. , (# % ! (#.($ % !-!# . .( @&(0 ! 8A & ! $,)! 0! / )( ! 0 % /,($, . (# / 3, # $ #.!( .# $ #( % ()( - ( 0 ., . ! )., $.( #. .!$2 &! ; - ( #. ! / 2( 0 #(. .( ., 0:# ! . .( $ . . 2 #0! . !., 0! # ! ## !., 0! # 6 . ., . ! ) ., , % ! (# $ - # ) $, ( #G % - !. /, # . ( -($ . #., . ) ., ! %- !. ) ! # $, ( /(.,., .. !
! "
#
$ %
# #
6 .#$, ! . 7 9$ ( #( ( ! /(., % ($ ( 0 --! $,G ( )$. ., % # $(.% ) ! $, E( .:# .( )! ., -! ( #)! ( ! !. -! ($. ., %- # ( ., ;. )! /,($, !#.!($.# ., $ - $(.% . . $. # $, 0 #( . ()., )! # ! (#. . ( .( ( , . 7 9 ( .! $ .!( % ($ # 3!( # ! )0! . ( . !#. ) ! ! #. .!$2( 0 . ., % ) !$ ., ! .( # .!$2 . #( ( !. ., # # ! ( ., .!( ( 0 # . 3, # )., # #/ 2 (. . . $. ., ! .# / ! ( . !#. ( . ., )$. ., . ., # .# / . $ ## !( % ( ., .!( ( 0 # . (.( (. # # ( -!$.($ . -! .!( # ) ! $, - ##(
#(. .(
. )., % 3, # ).!( # ( 0 ( $ .! ($.( /(., ., 0 ) ! #. % / -. .. # % % ($ /# # (., ! /,($, 2 # ! --! $, #( 0 !($
& #$ '
$
(.( . )( ( 0 ., . . , / / (.#$ )(0 !.( )(.#/(., ., ( 0 #, ! (#$ )(0 ! % # . ) # )., 8 0! # ))! 3, (2 (, ) $.( ).,(#$ )(0 !.( !-!# .( 0 ., 0! )#( ( !(.% /(., ., ( 0 . (#$ ( - !.($ )( . !( 0 $ . ;. !2 ! # #%#. # ., !2 !#- #(.( #( $, $ !:#( 0 - 0( # ., ! 6 - #(.( # ) ., !2 !# # --! $, # 7 9 7C9 . ;. ! --( 0 / # # . ! (#.($ % ! ! % ( 0 # 6 #-(. ., . 0 # (. -! ( # $! .( 0 .,(# .%- ) ( 0 # / #- $()($) ! $,- !# ., $ (.( # ) ., ( $ -. ! @ (0,. $ ., # .$A F 0 . $.( ) !0! # 0 . .( / ! # . $ #.! $. #( 0 ! ) $.( ( 7 9 H $, # . # #( - ) !0! # 0 . .( . $ #.! $. ! ) $.( $. % / $ #.! $. ., ( 0 % # .!$.( 0 -(; % -(; ., $20! )! ., $ !! . ( 0 ., --%( 0 .,!#, )( . ! 3,(#( 0 /( ., $ -! . ., #% ., .($ ( 0 !-!# .( 0 ! :# $ )(0 !.( @ 6 -! E$.( ) ! 6 %:# A . /,($, / / . . ##(0 ., ). ! # .!$.( 0., #% ., .($( 0 )! ., #( , .. ., / (0,. ) $.( /( $$ . %I
& & & /, !I & J ! )$ -(; # ./ ., ., #% ., .($( 0 & J ! )-(; #!-!# .( 0., & & J ! ) -(; # ) ., #% ., .($ ( 0 !-!# .( 0., & 3, $, ($ ).,(#) $.( (# .( . % ., )$. ., . / ( . )( ., :# $ )(0 !.( ., . ;( (# # ., (2 (, )(.# 6 -! E$.( . ., ! % - # 3,(#$ ( . !-!. % ,(0, !& / !@& ' & % $ # ) .(- $ !# ., / (0,. ) $.( / I 8
/, ! (#., ! )$ !# ., / (0,. $. )! ., ( 0 )$ ! 3,(# ., (# #( $ --( ( % $ (.( G, / ! (. %-!# . (.. / 2 ##( -!# $ ), %#, /# ( ., $ # ) - !# /(., # $ .,( 0 3,(# -! $ # % E#.( 0., .,!#, )( . !
& " ' ( ( &$ %$
)
(
*
'
# +
( (
( & % .( .!$2( 0 $ .! . # % #( #. . #.( .( -! !6 -# (# #. (#, .,! 0, ., $ )(0 !.( )., 0! # ) )! # .,(# $ )(0 !.( $ ., # !-!# . ., #. . $. ! )., ) (.( . ., #. . / )( # ! .( *+.,! 0, /,($, ., (2 (, ) #. . $. ! . .J.2 (# . %$ $ .( 0 @* D)A ! --! $, .,(# # ! .( / ., ( 0 )., - !# / ! .!$2( 0 ., ! (= ) :# $ )(0 !.( / !-!# . ., # ! .( -! ( (.%@ $%$ % J @* D) , AA 3, #. $ %2 / % #( .!$2 !(#., K &( . ! ! !. --% K )( . ! ., -! $ ## / #! #, , 4 ##( # ! .( -! ( (.% 4 ##( - #. !( ! -! ( (.% #(.% @)D * A /, ! * (# ., # ! .( # ,(#. !% . .2 6 .#$, !78 9 -! ., . ., - #. !( ! #(.% ( , .( $ -. ! (#
4 ##( .( ., # K &( . ! % $. - !%( .,(#.%- ) --($ .( !.($ )( . !( 0 # 2 / #., + # .( 0 !(., 7B9 -! . . , # $, .%- ) 4 ##( .( #(.( # )$. (. $ $ !. ( .% % .! # (..( 0 ## )(..( 0 #. . $ )(0 !.( # . .2 . . !.( #. -# ., #0( ( 0 ., $, $ . $, # - !.($ )( . !( 0 )! / !2 $, 6 :#$ )(0 !.( @ 8 0! # ))! $. !A (#!-!# . % - !.($ & ! $, - !.($ / (0,. (# ##(0 @ # #$!( ( $.( A . $, .( #. - 3, - #. !( ! #(.% (#!-!# . % ., # . ) - !.($ # ., (!/ (0,.#@&(0 ! A - !.($ )( . ! $ #(#.# ) ## .( #. -#@ . .2AI
% , -./
( I 0 ., # . ) - !.($ #$! . . .2 8 - !.($ # ! -($2 - /(., !- $ .G., -! ( (.% )# $.( 0 - !.($ (#-! - !.( . (.# ! (= / (0,. $)*%$ % IF $, - !.($ (# - . $$ ! ( 0 . .( )., #%#. G )2J 2L)2 8M #( (# A 2 @ 2 (# /,(. 4 #
" ' '
-
.,
+ I4( ., # ! .( *2 @( 0 . .2A ., ) ! $, - !.($ (# $ $ . 3, / (0,.# ! ., ! (= ., / - !.($ ## . (# # . .2M8 3, #. . )., #%#. . .2 (# #.( . % ., - !.($ , ( 0 ., 0! . #. ! ., !0 - !.($ ) ., - !.($ ## . 3, - !.($ )( . !( 0 $ ( / # # !$, ) ! ., #. - !.($ ( / )( - !.($ # . . $, .( #. ! !. , )(!!-!# . .( )., - #. !( ! #(.% ! (#.($#. . $. ! #.( .( $ !. ( ! )- !.($ # ! $ ## !% ,(0, ( #( #- $ .,(# ! $ #! .( % (0 3, # ) 0! . ! ! )- !.($ # #. .. ! !# .# ., ., ! , #( 0 ! - !.($ # 0 .# ., . - ! $ - ;(.% ) ., 0 !(., . ., )$. ., . . $, .( #. - ., )! - !.($ # #. $$ . 3, 0 ) ()( - !.($ )( . !( 0 0 !(., #(#. ! $ ., !) - !.($ # .,(# #- $( % ( ,(0, ( #( #- $ # /, ! ., $ - ;(.% $ 2 ., #($ - !.($ )( . !( 0 0 !(., -!$.($ % ( --($ 6 #-(. ., ,(0, ( #( ) !#. . $. ! @ 8 0! # ) )! A / -. . # - !.($ )( . !( 0 0 !(., . (.# $ - $(.% . , ., .( # ! .( -! ( (.% -! / ()( ., #($ 0 !(., % ( .! $( 0., ! ., . . #. !$ )(0 ! ., - !.($ # # !$, #- $ ( -.( /%
3, ! $ !% ( .! $ # #( ()($ .( # ., + # .( 0 !(., ( ! ! . -.( (# ., - !.($ # # !$, #- $ $ )(0 !.( 3, # ()($ .( # ! ( /% . -!# ! ., . 0 # - !.($ )( . ! ))!# (., ! % ($ ( 0 ! .( /# # #( 0 (. !.( - ! .( #. - (# $$ -(#, ;$ ( 0 % % ! # !$, H -!# ! ., #. -# #.! $. ! ) ., #($ - !.($ )( . !( 0 0 !(., . $,.( #. -.2 @&(0 ! AI ( I 3, - !.($ # # . $! . . .2 8 (# # !. %(.#/ (0,.# .,(## !. # . !) + (#.( $. - !.($ # ., . , ., (00 #. ! # $. 3,(#/ % ., $ - $(.% ) !)( . !. , .( #(.( #(#-!# ! I # / ! #- $( % ( . !#. ( # #- $()($ .# )., #. . $. ! / $ (## $( . (. ( . #. . $. !#I., )(!#. ' $ . ( ( 0 ., N( . !#.( 0: 0! # ))! ., # $ . $ !( 0 ., !#. ) ., )! 0! # F $, - !.($ (# / !-!# . % $. !# ( #. ) ' (# ., - . !- $ % .( ( #( . ! @#- $ A $ -# ) $. !# $ !( 0 0!( ) $. !# # !! ( 0 ., ( (.( $. ! ' ) ' , # ( #( # / )( ) ! $, ( #( ( $,* % ( . ! # !! ( 0 (.# 3,(# ( . ! (# ., (#$!.(# ( . # ., . !-!# . ., - ##( # ) ( . .2 ! !. $ ! $ ( .( # )- ##( # )., ( #( # )'+$. !#/( @ J- A 3,(# --! $,
(# ( #-(! % ., -!# $ ) -,%#( 0($ !#.!($.( # ., 0! # ))! .( @ 0 ;( 0 ! $(.% ) E( .# ( , .( A # !# . $, - !.($ /( - . !- $ % N (0, !: - !.($ # # # . $ !., /, - ##( $ )(0 !.( #- $ )., N( . !#.( 0: ( #( # $ # % # !! ( 0 ., - !.($ :# N( . !#.( 0: ( #( # $ )(0 !.( & ! $, - !.($ . (# ., - . % ( 0 /,(. (# $. ! 3, . . ! )- !.($ # /( ., 5 . +. 3, /( ., )., ( . ! ., ! ) $. !# ., . ! ) ., #%#. /( !( . ! 0! . ! -! ( ! $$ !. !# .# . !# . ( 0! . ! $ - . .( $ #. + I3,(# #. - ! ( # . ! G0( ., # ! .( *2 @( 0 . .2A ., ) ! $, - !.($ (#$ $ . @ # #$!( ( $.( A ., / - !.($ # # . (# -! - 0 . . $. !@ %- #A # . .2M8 3, #.( . #. . . .2 /( !-!# . %., - !.($ @., :# $ )(0 !.( A, ( 0., 0! . #.
! *,
0
1
+
3, + # .( 0 !(., # /(., . % .( /( ( ( ., # . ) - !.($ # ( . %# # .# ) ())! . #(= #@-! - !.( . $, # $. - !.($ AG., - !.($ #( $, # # . ! (#.!( . ! )., , ( #. - !.($ # ( ! ! -!# $ ) !#.!($.( # ., #. . $. ! .( ! ! !0 (# #., # . ) - !.($ # ( . + # # .# $, ) ! ) - !.($ #$ !( 0
( . ! ( (#.($ / % ., N (0, , ( #. - !.($ $/,* +% . ., -! 3, # ., ! !!( # !$, #- $ ., ., $ # .( 0 !(.,
!, : )., / ( #.( #. $! . # )(.. ! ., . $! . %
/ 3, !.($ . / # (#$, !$. !(# % - !.($ !- ( . @!-!# .( 0 ., # $! - ( .A/,($, / $ ., % !(0( !( !. #.( .( 0 ., % - !.# $ )(0 !.( / #, #.( . ., % !(0( :# 6 - #(.( !( . .( >#( 0 ., $ )(0 !.( )., % - !.#., . / # #.( . . .2 8 ., ( 0 . .2 / $ )( ., !(0( :# 6 - #(.( !( . .( 3,(#$ % --%( 0,( !!$,($ # !$, ! - ##( # ).,(# - #(.( @ $, ( #( # - !. %A F $, ) ., # - #(.( #-! $ # #% ., .($ 6 ( 0 )., !.($ . /,($, / $ - ! . ., ( 0 G., - #(.( -! $( 0 ., ( 0 ., . )(.# ., #. .,(# ( 0 (#$ #( ! . ., % !(0( :#- #(.( K /( 0 .,(#- #(.( / $ --% ., ! . #.( . ., % - !.#- #(.( # #/ ! #- $( % ( . !#. ( ., / !( # . ) !0 (. %#(# / $, # . --%., 0 !(., /(., ' !-!# .( 0 @ J A )., / ! ( #)! 0! #@2 # ,(-#! . .( #A #/ # ( ) #$ -. ! .
