Added beginnings of transformation matrix 3d