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

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