for (int i = 0; i < joints.Length; i++)
            {

                result[i] = Point3D.Multiply(joints[i], rotationMatrix);
                result[i] = result[i] + transVector;