From 1acd12168f51c4cd19f9f40c3b4bd5d77d424801 Mon Sep 17 00:00:00 2001 From: John Tsiombikas Date: Mon, 1 Oct 2018 22:39:39 +0300 Subject: [PATCH] chm_msubmatrix --- src/cgmmat.inl | 13 +++++++++++++ 1 file changed, 13 insertions(+) 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) -- 1.7.10.4