From: John Tsiombikas <nuclear@mutantstargoat.com>
Date: Mon, 1 Oct 2018 19:39:39 +0000 (+0300)
Subject: chm_msubmatrix
X-Git-Url: http://git.mutantstargoat.com/user/nuclear/?p=gph-cmath;a=commitdiff_plain;h=1acd12168f51c4cd19f9f40c3b4bd5d77d424801

chm_msubmatrix
---

diff --git a/src/cgmmat.inl b/src/cgmmat.inl
index 86dd63d..5afb224 100644
--- a/src/cgmmat.inl
+++ b/src/cgmmat.inl
@@ -79,6 +79,19 @@ static inline void cgm_mgetcol_v4(cgm_vec4 *v, const float *m, int idx)
 
 static inline void cgm_msubmatrix(float *m, int row, int col)
 {
+	int i, j;
+	for(i=0; i<4; i++) {
+		for(j=0; j<4; j++) {
+			int si = i;
+			int sj = j;
+			if(i >= col) si++;
+			if(j >= row) sj++;
+
+			if(si == i && sj == j) continue;
+
+			m[i * 4 + j] = m[si * 4 + sj];
+		}
+	}
 }
 
 static inline void cgm_mupper3(float *m)