modeling/src/maths/mat4/rightMultiplyVec3.js

  1. const fromValues = require('../vec3/fromValues')
  3. /**
  4.  * Multiply a 3D vector by a matrix (interpreted as 3 row, 1 column)
  5.  *
  6.  * Calculation: result = v*M, where the fourth element is set to 1.
  7.  * @param {vec3} vector - input vector
  8.  * @param {mat4} matrix - input matrix
  9.  * @returns {vec3} a new vector
  10.  * @alias module:modeling/maths/mat4.rightMultiplyVec3
  11.  */
  12. const rightMultiplyVec3 = (vector, matrix) => {
  13.   const [v0, v1, v2] = vector
  14.   const v3 = 1
  15.   let x = v0 * matrix[0] + v1 * matrix[1] + v2 * matrix[2] + v3 * matrix[3]
  16.   let y = v0 * matrix[4] + v1 * matrix[5] + v2 * matrix[6] + v3 * matrix[7]
  17.   let z = v0 * matrix[8] + v1 * matrix[9] + v2 * matrix[10] + v3 * matrix[11]
  18.   const w = v0 * matrix[12] + v1 * matrix[13] + v2 * matrix[14] + v3 * matrix[15]
  20.   // scale such that fourth element becomes 1:
  21.   if (w !== 1) {
  22.     const invw = 1.0 / w
  23.     x *= invw
  24.     y *= invw
  25.     z *= invw
  26.   }
  27.   return fromValues(x, y, z)
  28. }
  30. module.exports = rightMultiplyVec3