Prepostavljamo da su sve koordinate konacne (tj. Tz nije nula). Vi ste stavili 6, ali to treba da bude broj tacaka koje koristite.
Ako je A(Ax,Ay), B(Bx, By).... onda je T(Tx,Ty) = (Ax + Bx + ...., Ay + By + ....)/n , gde je n broj tacaka. Dakle teziste racunamo u afinim koordinatama (moze i u homogenim ako je treca koordinata svih tacaka jednaka 1).
Translacija je dobra.
Dobijate translirane tacke A(Ax1, Ay1), B(Bx1, By1).... i ZA NJIH odredjujete rastojanje od koord. pocetka.
Sve vam je dobro u koraku 4, ali treba da bude elemenat matrice skaliranja na poziciji (3,3) jednak 1, a ne 0!