1. DETERMINAZIONE DELLA RELAZIONE FONDAMENTALE DELLA CINEMATICA MEDIANTE SINGULAR VALUE DECOMPOSITION
Problema Dato l'insieme di coordinate {xi, yi; i=1,...,m, m≥3} determinare la matrice di orientamento R e il vettore posizione p della relazione y = R x + p
Soluzione - Calcolare la matrice di cross-dispersione Σ
Σ = 1⁄m ∑ (yi - ŷ) (xi - -x)T
dove -x = 1⁄m ∑ xi ; ŷ = 1⁄m ∑ yi.
- Effettuare la SVD di Σ
Σ = UΣVT
dove U e V sono matrici ortogonali e Σ è una matrice diagonale.
- La soluzione è R = UVT
p = ŷ - R -x
Note 1.
- Se rg (Σ) = 3 allora i punti sono distribuiti nello spazio.
- Se rg (Σ) = 2 allora i punti sono distribuiti su un piano.
- Se rg (Σ) = 1 allora i punti sono allineati.
2. Se det(R) = -1 il sistema è sinistrorso. Affinché sia destrorso (det(R)=1), R è calcolato nel seguente modo:
R = U × &LeftBracketingBar; -- -- -- -- -- diag(UVT)
2. MATRICI DI ROTAZIONE ELEMENTARI E ALGORITMO DI FU GONZALES
Rotazione intorno all'asse x
Rx,α= &LeftBracketingBar; -- -- -- -- -- -- -- -- -- --
Rotazione intorno all'asse z
Rz,θ= &LeftBracketingBar; -- -- -- -- -- -- -- -- -- --
Rotazione intorno all'asse y
Ry,φ= &LeftBracketingBar; -- -- -- -- -- -- -- -- --
Algoritmo di Fu Gonzales
- I sistemi sono inizialmente coincidenti: R è una matrice identità 3×3.
- Se il sistema ruota intorno a un degli assi del sistema fisso, si preimposta la corrispondente matrice elementare.
- Se intorno al mobile, si postmoltiplica.
1. DETERMINAZIONE DELLA RELAZIONE FONDAMENTALE DELLA CINEMATICA MEDIANTE SINGULAR VALUE DECOMPOSITION
Problema
Dato l'insieme di coordinate (xi, yi) ; i = 1, ..., m ; m ≥ 3
determinare la matrice di orientamento R e il vettore posizione ρ
della relazione y = R x + ρ
Soluzione
- Calcolare la matrice di covarianza zeta
∑ zeta = 1/m ∑(yi - ÿ)(xi - &xuml;)T
dove &xuml; = 1/m ∑xi ; ÿ = 1/m ∑yi
- effettuare la SVD di ζ
ζ = U Σ VT dove U e V sono matrici ortogonali e
Σ è una matrice diagonale
- La soluzione è R = U VT ρ = ÿ - R &xuml;
Note
- 1. Se rg(Σ) = 3 allora i punti sono distribuiti nello spazio
- 2. Se rg(Σ) = 2 allora i punti sono distribuiti su un piano
- 3. Se rg(Σ) = 1 allora i punti sono allineati
- 2. Se det(R) = -1 il sistema è sinistroso
Affinchè sia destrorso (det(Β) = 1), R è calcolata nel seguente modo
R = U
[ 1 0 0 ]
[ 0 1 0 ] 0 det(U VT)
[ 0 0 -1 ]
2. MATRICI DI ROTAZIONE ELEMENTARI E ALGORITMO DI FU GONZALES
Rotazione intorno all'asse x
- Rx,α =
[ 1 0 0 ]
[ 0 cosα -sinα ]
[ 0 sinα cosα ]
Rotazione intorno all'asse y
- Ry,φ =
[ cosφ 0 senφ ]
[ 0 1 0 ]
[ -senφ 0 cosφ ]