g3n-engine/math32/matrix3.go

// Copyright 2016 The G3N Authors. All rights reserved.
// Use of this source code is governed by a BSD-style
// license that can be found in the LICENSE file.

package math32

type Matrix3 [9]float32

func NewMatrix3() *Matrix3 {

	var m Matrix3
	m.Identity()
	return &m
}

func (m *Matrix3) Set(n11, n12, n13, n21, n22, n23, n31, n32, n33 float32) *Matrix3 {

	m[0] = n11
	m[3] = n12
	m[6] = n13
	m[1] = n21
	m[4] = n22
	m[7] = n23
	m[2] = n31
	m[5] = n32
	m[8] = n33
	return m
}

func (m *Matrix3) Identity() *Matrix3 {

	m.Set(
		1, 0, 0,
		0, 1, 0,
		0, 0, 1,
	)
	return m
}

func (m *Matrix3) Copy(src *Matrix3) *Matrix3 {

	*m = *src
	return m
}

func (m *Matrix3) ApplyToVector3Array(array []float32, offset int, length int) []float32 {

	var v1 Vector3
	j := offset
	for i := 0; i < length; i += 3 {
		v1.X = array[j]
		v1.Y = array[j+1]
		v1.Z = array[j+2]
		v1.ApplyMatrix3(m)
		array[j] = v1.X
		array[j+1] = v1.Y
		array[j+2] = v1.Z
	}
	return array
}

func (m *Matrix3) MultiplyScalar(s float32) *Matrix3 {

	m[0] *= s
	m[3] *= s
	m[6] *= s
	m[1] *= s
	m[4] *= s
	m[7] *= s
	m[2] *= s
	m[5] *= s
	m[8] *= s
	return m
}

func (m *Matrix3) Determinant() float32 {

	return m[0]*m[4]*m[8] -
		m[0]*m[5]*m[7] -
		m[1]*m[3]*m[8] +
		m[1]*m[5]*m[6] +
		m[2]*m[3]*m[7] -
		m[2]*m[4]*m[6]
}

func (m *Matrix3) GetInverse(src *Matrix4, throwOnInvertible bool) *Matrix3 {

	m[0] = src[10]*src[5] - src[6]*src[9]
	m[1] = -src[10]*src[1] + src[2]*src[9]
	m[2] = src[6]*src[1] - src[2]*src[5]
	m[3] = -src[10]*src[4] + src[6]*src[8]
	m[4] = src[10]*src[0] - src[2]*src[8]
	m[5] = -src[6]*src[0] + src[2]*src[4]
	m[6] = src[9]*src[4] - src[5]*src[8]
	m[7] = -src[9]*src[0] + src[1]*src[8]
	m[8] = src[5]*src[0] - src[1]*src[4]

	det := src[0]*m[0] + src[1]*m[3] + src[2]*m[6]

	// no inverse
	if det == 0 {
		if throwOnInvertible {
			panic("Matrix3.getInverse(): can't invert matrix, determinant is 0")
		}
		m.Identity()
		return m
	}
	m.MultiplyScalar(1.0 / det)
	return m
}

func (m *Matrix3) Transpose() *Matrix3 {

	var tmp float32
	tmp = m[1]
	m[1] = m[3]
	m[3] = tmp
	tmp = m[2]
	m[2] = m[6]
	m[6] = tmp
	tmp = m[5]
	m[5] = m[7]
	m[7] = tmp
	return m
}

func (m *Matrix3) FlattenToArrayOffset(array []float32, offset int) []float32 {

	copy(array[offset:], m[:])
	return array
}

func (m *Matrix3) GetNormalMatrix(src *Matrix4) *Matrix3 {

	m.GetInverse(src, true).Transpose()
	return m
}

func (m *Matrix3) TransposeIntoArray(r []float32) *Matrix3 {

	r[0] = m[0]
	r[1] = m[3]
	r[2] = m[6]
	r[3] = m[1]
	r[4] = m[4]
	r[5] = m[7]
	r[6] = m[2]
	r[7] = m[5]
	r[8] = m[8]
	return m
}

func (m *Matrix3) FromArray(array []float32) *Matrix3 {

	copy(m[:], array[:9])
	return m
}

func (m *Matrix3) ToArray() []float32 {

	var dst = make([]float32, 9)
	copy(dst, m[:])
	return dst
}

func (m *Matrix3) Clone() *Matrix3 {

	var cloned Matrix3
	cloned = *m
	return &cloned
}