Вычисление координат фигуры в OpenGL

glpushmatrix;
glrotatef(A,rotX,0,0);
glrotatef(A,0,rotY,0);
glrotatef(A,0,0,rotZ);
gltranslate(X,Y,Z);
glusphere(Q,0.1,10,10);
glpushmatrix;

procedure newcoord(  oX,oY,oZ, AX, AY, AZ: glfloat; var X1,Y1,Z1: glfloat ); 
//// oX,oY,oZ: координаты до поворота
//// AX, AY, AZ:углы по всем осям
// X1,Y1,Z1:  конечные координаты 
var tX,tY,tZ, tX1,ty1,tz1, tx2,ty2,tz2  :glfloat;
begin
// поворот относительно X
TZ:=OZ*cos(AX/180*pi)-oy*sin(AX/180*pi);
ty:=oZ*sin(AX/180*pi)+oy*cos(AX/180*pi);
tx:=ox;
// поворот относительно Y
TX1:=TX*cos(AY/180*pi)-tz*sin(AY/180*pi);
tZ1:= tX*sin(AY/180*pi)+tz*cos(AY/180*pi);
tY1:=ty;
// поворот относительно Z
Tx2:=tx1*cos(AZ/180*pi)-ty1*sin(AZ/180*pi);
ty2:=tx1*sin(AZ/180*pi)+ty1*cos(AZ/180*pi);
tz2:=tz1;
z1:=tz2;
X1:=tx2;
Y1:=ty2;
end;

procedure VEC_MultMatrix(source:t3D; mat:tMatrix; var Dest:t3D);
begin
    Dest.x:=Source.x*mat[1][1]+
            Source.y*mat[2][1]+
            Source.z*mat[3][1]+
                     mat[4][1];
    Dest.y:=Source.x*mat[1][2]+
            Source.y*mat[2][2]+
            Source.z*mat[3][2]+
                     mat[4][2];
    Dest.z:=Source.x*mat[1][3]+
            Source.y*mat[2][3]+
            Source.z*mat[3][3]+
                     mat[4][3];
end;

| 1 0 0 x |
| 0 1 0 y |
| 0 0 1 z |
| 0 0 0 1 |

var mat:TMatrix;
...
glMatrixMode(GL_MODELVIEW);
// текущая матрица - MODELVIEW
glLoadIdentity;
// установили текущую матрицу единичной
glTranslatef( x, y, z );// x,y,z - конкретные цифры которые занесутся в матрицу
// мы знаем что умнолжение любой матрицы(A) на единичную даст нам A
glGetFloatv( GL_MODELVIEW_MATRIX, @mat );
// после этой команды смотрим что занеслось в какую ячейку mat