Modelo de lentes: Pinhole, Delgada y Gruesa Parámetros del
Transcription
Modelo de lentes: Pinhole, Delgada y Gruesa Parámetros del
Tabla de Contenidos 37 8 Modelo de lentes: Pinhole, Delgada y Gruesa 8 Parámetros del Modelo de Captación 8 Sistemas de Coordenadas involucradas 4 Proceso de Calibración Visión Tridimensional UPM DISAM Proceso de Calibración 38 ãCALIBRACIÓN: Determinación de los parámetros involucrados en el proceso de captación: ëParámetros intrínsecos: ïFactores de escala: Kx, Ky ïDistancia focal: f ïPunto principal: C x, Cy ïDistorsión: D x, Dy ëParámetros extrínsecos: ïVector de traslación: T ïMatriz de rotación: R Visión Tridimensional UPM DISAM 1 Proceso de Calibración 39 ãEtapas del proceso de calibración ëEcuaciones del sistema: Modelo matemático ëObtención de datos de campo : Proyección sobre la imagen de puntos 3D conocidos ëDeterminación de los parámetros: Resolución de las ecuaciones con los datos de campo UPM DISAM Visión Tridimensional Proceso de calibración 40 Elemento de calibración Visión Tridimensional UPM DISAM 2 Proceso de Calibración 41 MÉTODOS DE CALIBRACIÓN ãTécnicas aplicadas a la Fotogrametría. ëSon necesarios métodos de calibración muy exactos. ëSe emplean ópticas profesionales sin problemas de distorsiones. ëConocimiento a priori de los parámetros intrínsecos. ãTécnicas aplicadas a la Robótica y Automatización. ëSon necesarios métodos rápidos y autónomos. ëImágenes con menor resolución. ëSe ven afectadas por muchos factores que de forma sistemática causan errores. Visión Tridimensional Proceso de Calibración UPM DISAM 42 MÉTODOS DE CALIBRACIÓN ãTécnicas basadas en Modelos con significado físico ëAproximación clásica de la fotogrametría ëTransformación Lineal Directa (DLT) ëRestricción de Alineamiento Radial (RAC) ëPunto de Desvanecimiento ãTécnicas basadas en Modelos matemáticos Visión Tridimensional UPM DISAM 3 Proceso de Calibración 43 Técnicas basadas en Modelos con significado físico. ëAproximación clásica de la fotogrametría. ïTienen en cuenta las ecuaciones convencionales de colinealidad del modelo pinhole de cámaras. ïResuelve el problema planteado realizando una optimización no lineal, para ello son necesarios buenos datos iniciales. ëTransformación Lineal Directa (DLT) ïSe realiza una calibración en dos pasos. þEn primer lugar se calculan los elementos de la Matriz de Proyección. þA partir de ella se obtienen los parámetros intrínsecos y extrínsecos. UPM DISAM Visión Tridimensional Proceso de Calibración 44 Técnicas basadas en modelos con significado físico. ëRestricción de Alineamiento Radial (RAC) ïIncorpora únicamente la distorsión radial, manteniendose la relación. Xu X d = Yu Yd ïSe necesita conocer inicialmente una serie de parámetros del conjunto cámara/tarjeta. ïEl resto de los parámetros se obtiene de forma lineal. ëPunto de Desvanecimiento ïCalcula separadamente los parámetros intrínsecos y los extrínsecos. ïMediante optimización no lineal se puede incorporar cualquier modelo de distorsión. Visión Tridimensional UPM DISAM 4 Proceso de Calibración 45 ãTécnicas basadas en un modelo matemático. ïNo se tiene ningún significado físico de la cámara. ïLa idea básica es la relación entre un punto del espacio 3D y la proyección de ese punto en la imagen 2D. Xf1 = Yf 1 = ïLa distorsión se compensa mediante interpolación. ∑c ∑c 0≤ i + j ≤3 (1 ) i j ij 1 w 1 w x y ( 3) i j ij 1w 1w 0 ≤i + j ≤ 3 x y ∑c ( 2) i j ij 1w 1w ∑c (3 ) i j ij 1w 1w 0≤i + j ≤3 0 ≤i + j ≤3 x y x y ïComo inconveniente destacar la poca utilidad cuando se desarrollan sistemas activos de visión. UPM DISAM Visión Tridimensional Proceso de Calibración 46 Transformación Lineal Directa (DLT) ë Obtención de los elementos de la matriz de proyección. ïSin considerar las restricciones ïConsiderando restricciones ë Cálculo de los parámetros intrínsecos y extrínsecos a excepción de la distorsión. ë Cálculo de la distorsión (si se modela). ë Cálculo de otros errores sistemáticos. xw n X f y m11 w n Y f = M z = m21 w n m31 1 Visión Tridimensional m12 m 22 m32 m13 m 23 m 33 xw m14 m1 y m 24 w = m2 zw m34 m3 1 m14 m 24 m34 xw y w zw 1 UPM DISAM 5 Proceso de Calibración 47 Transformación Lineal Directa (DLT) ëObtención de los elementos de la matriz de proyección m11xw + m12 yw + m13 zw + m14 x w X f = m x + m y + m z + m n X f m11 m12 m13 m14 31 w 32 w 33 w 34 n Y = m yw ⇒ m m m 22 23 24 f 21 z m x + m22 yw + m23 zw + m14 n m31 m32 m33 m34 w Y f = 21 w 1 m31xw + m32 yw + m33z w + m34 m31 xw X f + m32 yw X f + m33 zw X f + m34 X f − m11xw − m12 yw − m13z w − m14 = 0 m x Y +m y Y +m z Y +m Y −m x −m y −m z −m = 0 32 w f 33 w f 34 f 21 w 22 w 23 w 14 31 w f Sistema Am = 0 ⇒ Solución Trivial m =0 UPM DISAM Visión Tridimensional Método de Transformación Lineal Directa 48 Transformación Lineal Directa (DLT) ëCalculo de la Matriz de Proyección sin considerar las restricciones. m11 m34 1 m M = 21 m34 m m34 31 m34 m12 m34 m22 m34 m32 m34 m13 m34 m23 m34 m33 m34 m14 m34 L1 m24 → L = L5 m34 L9 1 L2 L3 L6 L10 L7 L11 L4 L8 1 xwL1 + yw L2 + zwL3 + L4 xwL9 + ywL10 + zwL11 + 1 x L + y L +z L +L Yf = w 5 w 6 w 7 8 xwL9 + ywL10 + zwL11 + 1 Xf = Visión Tridimensional UPM DISAM 6 Proceso de Calibración 49 Transformación Lineal Directa (DLT) ë Calculo de la Matriz de Proyección sin considerar las restricciones. Con n puntos (conocidos x wi , y wi , z wi , Xfi , Yfi ) se obtiene un sistema con 11 incógnitas y 2n ecuaciones xwi 0 ywi zwi 0 0 1 0 0 0 xwi ywi ⋅ 0 0 − xwi X fi − y wi X fi z wi 1 − xwi Y fi − ywiY fi ⋅ ⋅ L1 L2 L 3 − z wi X fi L4 X fi − z wi Y fi L5 Y fi L = ⋅ 6 L7 ⋅ L8 ⋅ L9 L 10 L 11 UPM DISAM Visión Tridimensional Proceso de Calibración 50 Transformación Lineal Directa (DLT) ëA partir de los parámetros L y considerando el significado físico de la matriz M se obtienen sus elementos. L1 L29 + L210 + L211 L M = 2 52 L9 + L10 + L211 L 2 92 2 L9 + L10 + L11 Visión Tridimensional L2 2 L9 + L210 + L211 L6 L3 2 L9 + L210 + L211 L7 L29 + L210 + L211 L10 L29 + L210 + L211 L11 L29 + L210 + L211 L29 + L210 + L211 L4 L29 + L210 + L211 L8 L29 + L210 + L211 1 L29 + L210 + L211 UPM DISAM 7 Proceso de Calibración 51 Transformación Lineal Directa (DLT) x m14 w y m 24 w z m34 w 1 sujeto a las restriccio nes nXf nYf n ëCálculo de la matriz de perspectiva considerando las restricciones a que está sujeta. m1 = m2 m 3 m3 = 1 (m1 ∧ m3 )⋅ (m 2 ∧ m3 ) = 0 ë Al emplear la segunda restricción se tiene que resolver un sistema no lineal que es algo que se pretende evitar con este método. UPM DISAM Visión Tridimensional Proceso de Calibración 52 Transformación Lineal Directa (DLT) ëSe utiliza exclusivamente la primera restricción. ëSe resuelve el problema de optimización dividiendo el conjunto de variables en dos, las que están sujetas a restricción y las que no, y empleando las técnicas de multiplicadores de Lagrange. 2 min Cy + Dz sujeto a z = 1 2 y,z 2 ( ) min R = Cy + Dz + λ⋅ 1− z 2 y,z Visión Tridimensional UPM DISAM 8 Proceso de Calibración 53 Transformación Lineal Directa (DLT) ëCalculo de los parámetros intrínsecos y extrínsecos. fKx r1 + Cx r3 M = fKy r2 + C y r3 r3 fKx tx + Cxtz m1 m14 fKyt y + Cy tz = m2 m24 m m tz 34 3 ïCálculo inmediato de r3 y de tz ïCoordenadas del Punto Principal m1 ⋅ m3 = ( fKxr1 + Cx r3 ) ⋅ r3T = fKx r1 ⋅ r3T + Cxr3 ⋅ r3T = Cx T ( T ) m2 ⋅ m3 = fKy r2 + Cyr3 ⋅ r3T = fKy r2 ⋅ r3T + Cyr3 ⋅ r3T = Cy UPM DISAM Visión Tridimensional Método de Transformación Lineal Directa 54 Transformación Lineal Directa (DLT) ëCalculo de los parámetros intrínsecos y extrínsecos. ïCalculo de las distancias focales en x e y. 2 [ − [ fK r ⋅ r ]= −C r ⋅r ] = T T • m1 ⋅ m1 − m1 ⋅ m3 = ( fKx r1 + C x r3 ) ⋅ ( fKx r1 + C x r3 )T − ( fKx r1 + C x r3 ) ⋅ r3 T fKx r1 ⋅ fKx r1T + Cx r3 ⋅ fKx r1 T + fKx r1 ⋅ Cx r3T + Cx r3 ⋅ C x r3 T 2 2 2 2 2 2 2 = f K x + Cx − Cx = f K x = f x ( 2 )( T T • m 2 ⋅ m2 − m 2 ⋅ m3 == fK y r2 + C y r3 ⋅ fK y r2 + C y r3 x 1 ⇒ 3 T 2 T 2 x 3 3 fx )T − [( fK y r2 + C y r3 )⋅ r3T ]2 = [ fK y r2 ⋅ fK y r2 T + C y r3 ⋅ fK y r2 T + fK y r2 ⋅ C y r3 T + C y r3 ⋅ C y r3T − fK y r2 ⋅ r3 T − C y r3 ⋅ r3T =f Visión Tridimensional 2 2 Ky 2 + Cy 2 − Cy = f 2 2 Ky = 2 fy ⇒ ] 2 = fy UPM DISAM 9 Método de Transformación Lineal Directa 55 Transformación Lineal Directa (DLT) ëCalculo de los parámetros intrínsecos y extrínsecos. ïCalculo de los parámetros extrínsecos restantes. m1 = fK x r1 + C x r3 ⇒ r1 = m 2 = fK y r2 + C y r3 ⇒ r2 = m14 = fK x t x + C x t z ⇒ tx = m 24 = fK y t y + C y t z ⇒ ty = m1 − C x r3 fK x m 2 − C y r3 fK y m14 − C x t z fK x m 24 − C y t z fK y UPM DISAM Visión Tridimensional Proceso de Calibración 56 Transformación Lineal Directa (DLT) ëCalculo de la Distorsión ïUn modelo mas completo al utilizado hasta el momento es el siguiente. X fsindistorsion + D X + dX f + n X = f Y fsindistorsion + D Y + d Y f + n Y = f x w m11 + y w m12 + z w m13 + m14 x w m31 + y w m32 + z w m33 + m34 x w m21 + y w m22 + z w m 23 + m24 x w m 31 + y w m32 + z w m33 + m 34 ïDespreciando todos los errores salvo la distorsión. X f − X f s i n d i s t o rs i o n = Dx Y f − Y f s i n d i s t o rs i o n = D Visión Tridimensional y UPM DISAM 10 Proceso de Calibración 57 Transformación Lineal Directa (DLT) ëCalculo de otros errores sistemáticos. ( ) X f − X fsindistorsion + DX = p0 + p1 X f + p2Yf + p3 X 2f + p4 X f Yf + p5Yf2 + p6 X 2f Yf + p7 X f Yf2 + p8 X 3f + p9Yf3 ( ) Yf − Yfsindistorsion + DY = q0 + q1Yf + q2 X f + q3Yf2 + q4 X f Yf + q5 X 2f + q6Yf2 X f + q7Yf X 2f + q8Yf3 + q9 X 3f ëEs conveniente calcular en pasos distintos los parámetros intrínsecos y extrínsecos, los coeficientes de distorsión y los coeficientes de otros errores sistemáticos para evitar inestabilidades. UPM DISAM Visión Tridimensional Proceso de Calibración 58 Restricción de Alineamiento Radial (RAC). Método Tsai ëEmplea un modelo de distorsión que solamente tiene en cuenta la distorsión radial. D x = X d ( k1r 2 + k2r 4 + ....) D y = Yd ( k1r 2 + k2r 4 +....) ëAl existir solamente distorsión Radial se obtiene xd x r x + r y + r z +t = u = 11 w 12 w 13 w x yd yu r21 xw + r22 y w + r23 z w + t y Visión Tridimensional UPM DISAM 11 Proceso de Calibración 59 Restricción de Alineamiento Radial (RAC). Método Tsai ëSe supone conocido Cx , Cy , Ky ëDeterminación de |R| , tx , ty ïCálculo de coordenadas centrales con distorsión ïCálculo de incógnitas intermedias (aj) ïCálculo de |ty | ïDeterminación del signo de ty ïCálculo de Sx ïCálculo de |R| , tx ëDeterminación de f , k1 , tz ïAproximación inicial de f , tz ïCálculo iterativo de f , k1 , tz UPM DISAM Visión Tridimensional Proceso de Calibración 60 Restricción de Alineamiento Radial (RAC). Método Tsai ïCálculo de coordenadas centrales con distorsión ( A partir de los puntos : x if , y if ( ( ) ) ) xˆ di = x if − C x = K x xdi Se obtiene i i i yˆ d = y f − C y = K y yd Si se forma el cociente : xˆdi K x xdi S x xui = = yˆ di K y y di yui con S x = Visión Tridimensional Kx Ky UPM DISAM 12 Proceso de Calibración 61 Restricción de Alineamiento Radial (RAC). Método Tsai ïCálculo de incógnitas intermedias (aj) Sustituyendo en el cociente xˆ id xui r11 xiw + r12 y iw + r13 zwi + t x = Sx i = Sx yˆ di yu r21 xwi + r22 yiw + r23 z iw + t y Si t y ≠ 0 xˆdi + t −y 1r21 xwi + t −y 1r22 ywi + t y−1r23 z wi = { { { a4 a5 a6 t S x r11 x yˆ + t S x r12 y yˆ di + t −y 1 S x r13 z iw yˆ di + t −y 1 S x t x yˆ id 123 123 123 123 −1 y i w i d −1 y a1 i w a2 a3 a7 UPM DISAM Visión Tridimensional Proceso de Calibración 62 Restricción de Alineamiento Radial (RAC). Método Tsai ïCálculo de incógnitas intermedias (aj) Se obtiene un sistema con n ecuaciones y 7 incógnitas xˆdi = a1 xiw yˆ di + a2 yiw yˆ di + a3 z iw yˆ id − a4 xwi − a5 yiw − a6 zwi + a7 yˆ di ïCálculo de |ty | ty = 1 a 42 + a 52 + a 62 ïDeterminación del signo de ty Para un punto cualquiera (alejado del centro de la imagen) se calcula su proyección sin distorsión, ensayando con el valor positivo y el valor negativo Visión Tridimensional UPM DISAM 13 Proceso de Calibración 63 Restricción de Alineamiento Radial (RAC). Método Tsai ïCálculo de Sx ( ) ty r13 = a3 S x = t y2 a12 + a 22 + a32 ïCálculo de |R| , tx r11 = a1 ty r12 = a2 Sx r21 = a4 t y Sx r22 = a5t y r31 = 1 − r112 − r212 t x = a7 ty Sx r23 = a6t y r32 = 1− r122 − r222 r33 = 1 − r132 − r232 ty Sx UPM DISAM Visión Tridimensional Proceso de Calibración 64 Restricción de Alineamiento Radial (RAC). Método Tsai ë Determinación de f , k 1 , tz ïAproximación inicial de f , tz þSe obtiene f , tz con distorsión nula, mediante mínimos cuadrados ïCálculo iterativo de f , k1 , tz þOptimización no lineal del sistema [ ] xˆ di = K x k 1 (xˆ id ) + ( yˆ di ) + K x f [ yˆ di = K y k 1 (xˆ di Visión Tridimensional 2 2 ) + ( yˆ ) ]+ K 2 i d 2 y f r11 x iw + r12 y wi + r13 z wi + t x r31 x wi + r32 y iw + r33 z wi + t z r21 x wi + r22 y wi + r23 z iw + t x r31 x iw + r32 y wi + r33 z wi + t z UPM DISAM 14 Proceso de Calibración 65 El proceso de calibración produce parámetros poco robustos, con alto grado de inestabilidad ãCausas posibles ëModelo matemático incompleto ëErrores en la adquisición de los datos ëMal comportamiento de los algoritmos de calibración ãConsecuencia ëMala precisión en las aplicaciones de visión tridimensional Visión Tridimensional UPM DISAM 15