Exemplo n.º 1
0
        public static Vector3 Multiply(this Matrix matrix, Vector3 vector)
        {
            if (matrix == null)
            {
                throw new ArgumentNullException("matrix");
            }
            if (vector == null)
            {
                throw new ArgumentNullException("vector");
            }

            var product = new Vector3();

            for (var i = 0; i < 3; i++)
            {
                for (var k = 0; k < 3; k++)
                {
                    product.SetIndex(i, product.Index(i) + matrix[i, k] * vector.Index(k));
                }
            }

            return(product);
        }