Create rotation/translation matrix:
// Roll, Pitch, Yaw, Translate
FUNCTION BuildMatrix: ry, rz, rx, x, y, z, M[]
LOCAL sa,sb,sc, ca,cb,cc
LOCAL sacb, cacb
DIM M[16]
//LOCAL a[], B[], C[]
// NewtonRollMatrix (rx, a[])
// NewtonPitchMatrix(ry, B[])
// NewtonMultMatrix(a[], B[], C[])
// NewtonYawMatrix (rz, a[])
// NewtonMultMatrix(a[], C[], M[])
// M[12]= x
// M[13]= y
// M[14]= z
ca = COS(-ry);
sa = SIN(-ry);
sb = COS(rz);
cb = SIN(rz);
cc = COS(-rx);
sc = SIN(-rx);
sacb=sa*cb
cacb=ca*cb
M[0] = sb * cc;
M[1] = -sb * sc;
M[2] = -cb;
M[4] = -sacb * cc + ca * sc;
M[5] = sacb * sc + ca * cc;
M[6] = -sa * sb;
M[8] = cacb * cc + sa * sc;
M[9] = -cacb * sc + sa * cc;
M[10] = ca * sb;
M[12]= x
M[13]= y
M[14]= z
M[15]= 1;
ENDFUNCTION