jp9000
/
obs-studio
1
0
Fork 0
Code Issues Pull Requests Packages Projects Releases Wiki Activity

Change graphics subsystem to 4x4 matrices 

4x4 matrices aren't as optimal, but are much more sensible to handle
when you want to do more advanced stuff like scaling, skewing, or
inversion.
master
jp9000 2014-06-14 23:09:13 -07:00
parent c2eebd8d1d
commit 1c2a0524b7
19 changed files with 363 additions and 92 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

5
libobs-d3d11/d3d11-subsystem.cpp
View File

@ -367,10 +367,7 @@ void gs_device::UpdateBlendState()
void gs_device::UpdateViewProjMatrix()
{
matrix3 cur_matrix;
gs_matrix_get(&cur_matrix);
matrix4_from_matrix3(&curViewMatrix, &cur_matrix);
gs_matrix_get(&curViewMatrix);
/* negate Z col of the view matrix for right-handed coordinate system */
curViewMatrix.x.z = -curViewMatrix.x.z;

4
libobs-opengl/gl-subsystem.c
View File

@ -866,10 +866,8 @@ static inline bool can_render(device_t device)
static void update_viewproj_matrix(struct gs_device *device)
{
struct gs_shader *vs = device->cur_vertex_shader;
struct matrix3 cur_matrix;
gs_matrix_get(&cur_matrix);
gs_matrix_get(&device->cur_view);
matrix4_from_matrix3(&device->cur_view, &cur_matrix);
matrix4_mul(&device->cur_viewproj, &device->cur_view,
&device->cur_proj);
matrix4_transpose(&device->cur_viewproj, &device->cur_viewproj);

69
libobs/graphics/bounds.c
View File

@ -17,6 +17,7 @@
#include "bounds.h"
#include "matrix3.h"
#include "matrix4.h"
#include "plane.h"
void bounds_move(struct bounds *dst, const struct bounds *b,
@ -83,7 +84,7 @@ void bounds_get_center(struct vec3 *dst, const struct bounds *b)
}
void bounds_transform(struct bounds *dst, const struct bounds *b,
const struct matrix3 *m)
const struct matrix4 *m)
{
struct bounds temp;
bool b_init = false;
@ -101,17 +102,54 @@ void bounds_transform(struct bounds *dst, const struct bounds *b,
} else {
if (p.x < temp.min.x)
temp.min.x = p.x;
else if(p.x > temp.max.x)
else if (p.x > temp.max.x)
temp.max.x = p.x;
if(p.y < temp.min.y)
if (p.y < temp.min.y)
temp.min.y = p.y;
else if(p.y > temp.max.y)
else if (p.y > temp.max.y)
temp.max.y = p.y;
if(p.z < temp.min.z)
if (p.z < temp.min.z)
temp.min.z = p.z;
else if(p.z > temp.max.z)
else if (p.z > temp.max.z)
temp.max.z = p.z;
}
}
bounds_copy(dst, &temp);
}
void bounds_transform3x4(struct bounds *dst, const struct bounds *b,
const struct matrix3 *m)
{
struct bounds temp;
bool b_init = false;
int i;
for (i = 0; i < 8; i++) {
struct vec3 p;
bounds_get_point(&p, b, i);
vec3_transform3x4(&p, &p, m);
if (!b_init) {
vec3_copy(&temp.min, &p);
vec3_copy(&temp.max, &p);
b_init = true;
} else {
if (p.x < temp.min.x)
temp.min.x = p.x;
else if (p.x > temp.max.x)
temp.max.x = p.x;
if (p.y < temp.min.y)
temp.min.y = p.y;
else if (p.y > temp.max.y)
temp.max.y = p.y;
if (p.z < temp.min.z)
temp.min.z = p.z;
else if (p.z > temp.max.z)
temp.max.z = p.z;
}
}
@ -227,6 +265,21 @@ bool bounds_intersects(const struct bounds *b, const struct bounds *test,
}
bool bounds_intersects_obb(const struct bounds *b, const struct bounds *test,
const struct matrix4 *m, float epsilon)
{
struct bounds b_tr, test_tr;
struct matrix4 m_inv;
matrix4_inv(&m_inv, m);
bounds_transform(&b_tr, b, m);
bounds_transform(&test_tr, test, &m_inv);
return bounds_intersects(b, &test_tr, epsilon) &&
bounds_intersects(&b_tr, test, epsilon);
}
bool bounds_intersects_obb3x4(const struct bounds *b, const struct bounds *test,
const struct matrix3 *m, float epsilon)
{
struct bounds b_tr, test_tr;
@ -234,8 +287,8 @@ bool bounds_intersects_obb(const struct bounds *b, const struct bounds *test,
matrix3_transpose(&m_inv, m);
bounds_transform(&b_tr, b, m);
bounds_transform(&test_tr, test, &m_inv);
bounds_transform3x4(&b_tr, b, m);
bounds_transform3x4(&test_tr, test, &m_inv);
return bounds_intersects(b, &test_tr, epsilon) &&
bounds_intersects(&b_tr, test, epsilon);

5
libobs/graphics/bounds.h
View File

@ -72,6 +72,8 @@ EXPORT void bounds_get_center(struct vec3 *dst, const struct bounds *b);
* the actual size becoming larger than it originally was.
*/
EXPORT void bounds_transform(struct bounds *dst, const struct bounds *b,
const struct matrix4 *m);
EXPORT void bounds_transform3x4(struct bounds *dst, const struct bounds *b,
const struct matrix3 *m);
EXPORT bool bounds_intersection_ray(const struct bounds *b,
@ -108,6 +110,9 @@ static inline bool bounds_vec3_inside(const struct bounds *b,
EXPORT bool bounds_intersects(const struct bounds *b,
const struct bounds *test, float epsilon);
EXPORT bool bounds_intersects_obb(const struct bounds *b,
const struct bounds *test, const struct matrix4 *m,
float epsilon);
EXPORT bool bounds_intersects_obb3x4(const struct bounds *b,
const struct bounds *test, const struct matrix3 *m,
float epsilon);

2
libobs/graphics/graphics-internal.h
View File

@ -229,7 +229,7 @@ struct graphics_subsystem {
DARRAY(struct gs_rect) viewport_stack;
DARRAY(struct matrix3) matrix_stack;
DARRAY(struct matrix4) matrix_stack;
size_t cur_matrix;
struct matrix4 projection;

64
libobs/graphics/graphics.c
View File

@ -87,9 +87,9 @@ static bool graphics_init_sprite_vb(struct graphics_subsystem *graphics)
static bool graphics_init(struct graphics_subsystem *graphics)
{
struct matrix3 top_mat;
struct matrix4 top_mat;
matrix3_identity(&top_mat);
matrix4_identity(&top_mat);
da_push_back(graphics->matrix_stack, &top_mat);
graphics->exports.device_entercontext(graphics->device);
@ -203,7 +203,7 @@ graphics_t gs_getcontext(void)
return thread_graphics;
}
static inline struct matrix3 *top_matrix(graphics_t graphics)
static inline struct matrix4 *top_matrix(graphics_t graphics)
{
return graphics ?
(graphics->matrix_stack.array + graphics->cur_matrix) : NULL;
@ -215,9 +215,9 @@ void gs_matrix_push(void)
if (!graphics)
return;
struct matrix3 mat, *top_mat = top_matrix(graphics);
struct matrix4 mat, *top_mat = top_matrix(graphics);
memcpy(&mat, top_mat, sizeof(struct matrix3));
memcpy(&mat, top_mat, sizeof(struct matrix4));
da_push_back(graphics->matrix_stack, &mat);
graphics->cur_matrix++;
}
@ -239,97 +239,97 @@ void gs_matrix_pop(void)
void gs_matrix_identity(void)
{
struct matrix3 *top_mat = top_matrix(thread_graphics);
struct matrix4 *top_mat = top_matrix(thread_graphics);
if (top_mat)
matrix3_identity(top_mat);
matrix4_identity(top_mat);
}
void gs_matrix_transpose(void)
{
struct matrix3 *top_mat = top_matrix(thread_graphics);
struct matrix4 *top_mat = top_matrix(thread_graphics);
if (top_mat)
matrix3_transpose(top_mat, top_mat);
matrix4_transpose(top_mat, top_mat);
}
void gs_matrix_set(const struct matrix3 *matrix)
void gs_matrix_set(const struct matrix4 *matrix)
{
struct matrix3 *top_mat = top_matrix(thread_graphics);
struct matrix4 *top_mat = top_matrix(thread_graphics);
if (top_mat)
matrix3_copy(top_mat, matrix);
matrix4_copy(top_mat, matrix);
}
void gs_matrix_get(struct matrix3 *dst)
void gs_matrix_get(struct matrix4 *dst)
{
struct matrix3 *top_mat = top_matrix(thread_graphics);
struct matrix4 *top_mat = top_matrix(thread_graphics);
if (top_mat)
matrix3_copy(dst, top_mat);
matrix4_copy(dst, top_mat);
}
void gs_matrix_mul(const struct matrix3 *matrix)
void gs_matrix_mul(const struct matrix4 *matrix)
{
struct matrix3 *top_mat = top_matrix(thread_graphics);
struct matrix4 *top_mat = top_matrix(thread_graphics);
if (top_mat)
matrix3_mul(top_mat, top_mat, matrix);
matrix4_mul(top_mat, top_mat, matrix);
}
void gs_matrix_rotquat(const struct quat *rot)
{
struct matrix3 *top_mat = top_matrix(thread_graphics);
struct matrix4 *top_mat = top_matrix(thread_graphics);
if (top_mat)
matrix3_rotate(top_mat, top_mat, rot);
matrix4_rotate(top_mat, top_mat, rot);
}
void gs_matrix_rotaa(const struct axisang *rot)
{
struct matrix3 *top_mat = top_matrix(thread_graphics);
struct matrix4 *top_mat = top_matrix(thread_graphics);
if (top_mat)
matrix3_rotate_aa(top_mat, top_mat, rot);
matrix4_rotate_aa(top_mat, top_mat, rot);
}
void gs_matrix_translate(const struct vec3 *pos)
{
struct matrix3 *top_mat = top_matrix(thread_graphics);
struct matrix4 *top_mat = top_matrix(thread_graphics);
if (top_mat)
matrix3_translate(top_mat, top_mat, pos);
matrix4_translate3v(top_mat, top_mat, pos);
}
void gs_matrix_scale(const struct vec3 *scale)
{
struct matrix3 *top_mat = top_matrix(thread_graphics);
struct matrix4 *top_mat = top_matrix(thread_graphics);
if (top_mat)
matrix3_scale(top_mat, top_mat, scale);
matrix4_scale(top_mat, top_mat, scale);
}
void gs_matrix_rotaa4f(float x, float y, float z, float angle)
{
struct matrix3 *top_mat = top_matrix(thread_graphics);
struct matrix4 *top_mat = top_matrix(thread_graphics);
struct axisang aa;
if (top_mat) {
axisang_set(&aa, x, y, z, angle);
matrix3_rotate_aa(top_mat, top_mat, &aa);
matrix4_rotate_aa(top_mat, top_mat, &aa);
}
}
void gs_matrix_translate3f(float x, float y, float z)
{
struct matrix3 *top_mat = top_matrix(thread_graphics);
struct matrix4 *top_mat = top_matrix(thread_graphics);
struct vec3 p;
if (top_mat) {
vec3_set(&p, x, y, z);
matrix3_translate(top_mat, top_mat, &p);
matrix4_translate3v(top_mat, top_mat, &p);
}
}
void gs_matrix_scale3f(float x, float y, float z)
{
struct matrix3 *top_mat = top_matrix(thread_graphics);
struct matrix4 *top_mat = top_matrix(thread_graphics);
struct vec3 p;
if (top_mat) {
vec3_set(&p, x, y, z);
matrix3_scale(top_mat, top_mat, &p);
matrix4_scale(top_mat, top_mat, &p);
}
}

6
libobs/graphics/graphics.h
View File

@ -441,9 +441,9 @@ EXPORT void gs_matrix_push(void);
EXPORT void gs_matrix_pop(void);
EXPORT void gs_matrix_identity(void);
EXPORT void gs_matrix_transpose(void);
EXPORT void gs_matrix_set(const struct matrix3 *matrix);
EXPORT void gs_matrix_get(struct matrix3 *dst);
EXPORT void gs_matrix_mul(const struct matrix3 *matrix);
EXPORT void gs_matrix_set(const struct matrix4 *matrix);
EXPORT void gs_matrix_get(struct matrix4 *dst);
EXPORT void gs_matrix_mul(const struct matrix4 *matrix);
EXPORT void gs_matrix_rotquat(const struct quat *rot);
EXPORT void gs_matrix_rotaa(const struct axisang *rot);
EXPORT void gs_matrix_translate(const struct vec3 *pos);

40
libobs/graphics/matrix3.c
View File

@ -37,21 +37,9 @@ void matrix3_from_quat(struct matrix3 *dst, const struct quat *q)
float wy = q->w * q->y * s;
float wz = q->w * q->z * s;
dst->x.x = 1.0f - (yy + zz);
dst->x.y = xy + wz;
dst->x.z = xz - wy;
dst->x.w = 0.0f;
dst->y.x = xy - wz;
dst->y.y = 1.0f - (xx + zz);
dst->y.z = yz + wx;
dst->y.w = 0.0f;
dst->z.x = xz + wy;
dst->z.y = yz - wx;
dst->z.z = 1.0f - (xx + yy);
dst->z.w = 0.0f;
vec3_set(&dst->x, 1.0f - (yy + zz), xy + wz, xz - wy);
vec3_set(&dst->y, xy - wz, 1.0f - (xx + zz), yz + wx);
vec3_set(&dst->z, xz + wy, yz - wx, 1.0f - (xx + yy));
vec3_zero(&dst->t);
}
@ -77,10 +65,19 @@ void matrix3_from_matrix4(struct matrix3 *dst, const struct matrix4 *m)
void matrix3_mul(struct matrix3 *dst, const struct matrix3 *m1,
const struct matrix3 *m2)
{
vec3_rotate(&dst->x, &m1->x, m2);
vec3_rotate(&dst->y, &m1->y, m2);
vec3_rotate(&dst->z, &m1->z, m2);
vec3_transform(&dst->t, &m1->t, m2);
if (dst == m2) {
struct matrix3 temp;
vec3_rotate(&temp.x, &m1->x, m2);
vec3_rotate(&temp.y, &m1->y, m2);
vec3_rotate(&temp.z, &m1->z, m2);
vec3_transform3x4(&temp.t, &m1->t, m2);
matrix3_copy(dst, &temp);
} else {
vec3_rotate(&dst->x, &m1->x, m2);
vec3_rotate(&dst->y, &m1->y, m2);
vec3_rotate(&dst->z, &m1->z, m2);
vec3_transform3x4(&dst->t, &m1->t, m2);
}
}
void matrix3_rotate(struct matrix3 *dst, const struct matrix3 *m,
@ -123,7 +120,10 @@ void matrix3_transpose(struct matrix3 *dst, const struct matrix3 *m)
void matrix3_inv(struct matrix3 *dst, const struct matrix3 *m)
{
matrix4_inv((struct matrix4*)dst, (struct matrix4*)m);
struct matrix4 m4;
matrix4_from_matrix3(&m4, m);
matrix4_inv((struct matrix4*)dst, &m4);
dst->t.w = 0.0f;
}
void matrix3_mirror(struct matrix3 *dst, const struct matrix3 *m,

26
libobs/graphics/matrix3.h
View File

@ -18,6 +18,7 @@
#pragma once
#include "vec3.h"
#include "axisang.h"
/* 3x4 Matrix */
@ -25,7 +26,6 @@
extern "C" {
#endif
struct axisang;
struct matrix4;
struct matrix3 {
@ -79,6 +79,30 @@ EXPORT void matrix3_mirror(struct matrix3 *dst, const struct matrix3 *m,
EXPORT void matrix3_mirrorv(struct matrix3 *dst, const struct matrix3 *m,
const struct vec3 *v);
static inline void matrix3_translate3f(struct matrix3 *dst,
const struct matrix3 *m, float x, float y, float z)
{
struct vec3 v;
vec3_set(&v, x, y, z);
matrix3_translate(dst, m, &v);
}
static inline void matrix3_rotate_aa4f(struct matrix3 *dst,
const struct matrix3 *m, float x, float y, float z, float rot)
{
struct axisang aa;
axisang_set(&aa, x, y, z, rot);
matrix3_rotate_aa(dst, m, &aa);
}
static inline void matrix3_scale3f(struct matrix3 *dst,
const struct matrix3 *m, float x, float y, float z)
{
struct vec3 v;
vec3_set(&v, x, y, z);
matrix3_scale(dst, m, &v);
}
#ifdef __cplusplus
}
#endif

88
libobs/graphics/matrix4.c
View File

@ -18,6 +18,7 @@
#include "math-defs.h"
#include "matrix4.h"
#include "matrix3.h"
#include "quat.h"
void matrix4_from_matrix3(struct matrix4 *dst, const struct matrix3 *m)
{
@ -28,6 +29,34 @@ void matrix4_from_matrix3(struct matrix4 *dst, const struct matrix3 *m)
dst->t.w = 1.0f;
}
void matrix4_from_quat(struct matrix4 *dst, const struct quat *q)
{
float norm = quat_dot(q, q);
float s = (norm > 0.0f) ? (2.0f/norm) : 0.0f;
float xx = q->x * q->x * s;
float yy = q->y * q->y * s;
float zz = q->z * q->z * s;
float xy = q->x * q->y * s;
float xz = q->x * q->z * s;
float yz = q->y * q->z * s;
float wx = q->w * q->x * s;
float wy = q->w * q->y * s;
float wz = q->w * q->z * s;
vec4_set(&dst->x, 1.0f - (yy + zz), xy + wz, xz - wy, 0.0f);
vec4_set(&dst->y, xy - wz, 1.0f - (xx + zz), yz + wx, 0.0f);
vec4_set(&dst->z, xz + wy, yz - wx, 1.0f - (xx + yy), 0.0f);
vec4_set(&dst->t, 0.0f, 0.0f, 0.0f, 1.0f);
}
void matrix4_from_axisang(struct matrix4 *dst, const struct axisang *aa)
{
struct quat q;
quat_from_axisang(&q, aa);
matrix4_from_quat(dst, &q);
}
void matrix4_mul(struct matrix4 *dst, const struct matrix4 *m1,
const struct matrix4 *m2)
{
@ -98,6 +127,57 @@ float matrix4_determinant(const struct matrix4 *m)
return result;
}
void matrix4_translate3v(struct matrix4 *dst, const struct matrix4 *m,
const struct vec3 *v)
{
struct matrix4 temp;
vec4_set(&temp.x, 1.0f, 0.0f, 0.0f, 0.0f);
vec4_set(&temp.y, 0.0f, 1.0f, 0.0f, 0.0f);
vec4_set(&temp.z, 0.0f, 0.0f, 1.0f, 0.0f);
vec4_from_vec3(&temp.t, v);
matrix4_mul(dst, m, &temp);
}
void matrix4_translate4v(struct matrix4 *dst, const struct matrix4 *m,
const struct vec4 *v)
{
struct matrix4 temp;
vec4_set(&temp.x, 1.0f, 0.0f, 0.0f, 0.0f);
vec4_set(&temp.y, 0.0f, 1.0f, 0.0f, 0.0f);
vec4_set(&temp.z, 0.0f, 0.0f, 1.0f, 0.0f);
vec4_copy(&temp.t, v);
matrix4_mul(dst, m, &temp);
}
void matrix4_rotate(struct matrix4 *dst, const struct matrix4 *m,
const struct quat *q)
{
struct matrix4 temp;
matrix4_from_quat(&temp, q);
matrix4_mul(dst, m, &temp);
}
void matrix4_rotate_aa(struct matrix4 *dst, const struct matrix4 *m,
const struct axisang *aa)
{
struct matrix4 temp;
matrix4_from_axisang(&temp, aa);
matrix4_mul(dst, m, &temp);
}
void matrix4_scale(struct matrix4 *dst, const struct matrix4 *m,
const struct vec3 *v)
{
struct matrix4 temp;
vec4_set(&temp.x, v->x, 0.0f, 0.0f, 0.0f);
vec4_set(&temp.y, 0.0f, v->y, 0.0f, 0.0f);
vec4_set(&temp.z, 0.0f, 0.0f, v->z, 0.0f);
vec4_set(&temp.t, 0.0f, 0.0f, 0.0f, 1.0f);
matrix4_mul(dst, m, &temp);
}
bool matrix4_inv(struct matrix4 *dst, const struct matrix4 *m)
{
struct vec4 *dstv = (struct vec4 *)dst;
@ -105,6 +185,14 @@ bool matrix4_inv(struct matrix4 *dst, const struct matrix4 *m)
float m3x3[9];
int i, j, sign;
if (dst == m) {
struct matrix4 temp = *m;
return matrix4_inv(dst, &temp);
}
dstv = (struct vec4 *)dst;
det = matrix4_determinant(m);
if (fabs(det) < 0.0005f)
return false;

39
libobs/graphics/matrix4.h
View File

@ -17,7 +17,9 @@
#pragma once
#include "vec3.h"
#include "vec4.h"
#include "axisang.h"
/* 4x4 Matrix */
@ -52,15 +54,52 @@ static inline void matrix4_identity(struct matrix4 *dst)
}
EXPORT void matrix4_from_matrix3(struct matrix4 *dst, const struct matrix3 *m);
EXPORT void matrix4_from_quat(struct matrix4 *dst, const struct quat *q);
EXPORT void matrix4_from_axisang(struct matrix4 *dst,
const struct axisang *aa);
EXPORT void matrix4_mul(struct matrix4 *dst, const struct matrix4 *m1,
const struct matrix4 *m2);
EXPORT float matrix4_determinant(const struct matrix4 *m);
EXPORT void matrix4_translate3v(struct matrix4 *dst, const struct matrix4 *m,
const struct vec3 *v);
EXPORT void matrix4_translate4v(struct matrix4 *dst, const struct matrix4 *m,
const struct vec4 *v);
EXPORT void matrix4_rotate(struct matrix4 *dst, const struct matrix4 *m,
const struct quat *q);
EXPORT void matrix4_rotate_aa(struct matrix4 *dst, const struct matrix4 *m,
const struct axisang *aa);
EXPORT void matrix4_scale(struct matrix4 *dst, const struct matrix4 *m,
const struct vec3 *v);
EXPORT bool matrix4_inv(struct matrix4 *dst, const struct matrix4 *m);
EXPORT void matrix4_transpose(struct matrix4 *dst, const struct matrix4 *m);
static inline void matrix4_translate3f(struct matrix4 *dst,
const struct matrix4 *m, float x, float y, float z)
{
struct vec3 v;
vec3_set(&v, x, y, z);
matrix4_translate3v(dst, m, &v);
}
static inline void matrix4_rotate_aa4f(struct matrix4 *dst,
const struct matrix4 *m, float x, float y, float z, float rot)
{
struct axisang aa;
axisang_set(&aa, x, y, z, rot);
matrix4_rotate_aa(dst, m, &aa);
}
static inline void matrix4_scale3f(struct matrix4 *dst,
const struct matrix4 *m, float x, float y, float z)
{
struct vec3 v;
vec3_set(&v, x, y, z);
matrix4_scale(dst, m, &v);
}
#ifdef __cplusplus
}
#endif

18
libobs/graphics/plane.c
View File

@ -34,14 +34,28 @@ void plane_from_tri(struct plane *dst,
}
void plane_transform(struct plane *dst, const struct plane *p,
const struct matrix3 *m)
const struct matrix4 *m)
{
struct vec3 temp;
vec3_zero(&temp);
vec3_transform(&dst->dir, &p->dir, m);
vec3_norm(&dst->dir, &dst->dir);
vec3_transform(&temp, &m->t, m);
vec3_transform(&temp, &temp, m);
dst->dist = p->dist - vec3_dot(&dst->dir, &temp);
}
void plane_transform3x4(struct plane *dst, const struct plane *p,
const struct matrix3 *m)
{
struct vec3 temp;
vec3_transform3x4(&dst->dir, &p->dir, m);
vec3_norm(&dst->dir, &dst->dir);
vec3_transform3x4(&temp, &m->t, m);
dst->dist = p->dist - vec3_dot(&dst->dir, &temp);
}

3
libobs/graphics/plane.h
View File

@ -25,6 +25,7 @@ extern "C" {
#endif
struct matrix3;
struct matrix4;
struct plane {
struct vec3 dir;
@ -57,6 +58,8 @@ EXPORT void plane_from_tri(struct plane *dst,
const struct vec3 *v3);
EXPORT void plane_transform(struct plane *dst, const struct plane *p,
const struct matrix4 *m);
EXPORT void plane_transform3x4(struct plane *dst, const struct plane *p,
const struct matrix3 *m);
EXPORT bool plane_intersection_ray(const struct plane *p,

32
libobs/graphics/quat.c
View File

@ -18,6 +18,7 @@
#include "quat.h"
#include "vec3.h"
#include "matrix3.h"
#include "matrix4.h"
#include "axisang.h"
static inline void quat_vec3(struct vec3 *v, const struct quat *q)
@ -59,6 +60,11 @@ struct f4x4 {
};
void quat_from_matrix3(struct quat *dst, const struct matrix3 *m)
{
quat_from_matrix4(dst, (const struct matrix4*)m);
}
void quat_from_matrix4(struct quat *dst, const struct matrix4 *m)
{
float tr = (m->x.x + m->y.y + m->z.z);
float inv_half;
@ -66,13 +72,13 @@ void quat_from_matrix3(struct quat *dst, const struct matrix3 *m)
int i,j,k;
if (tr > 0.0f) {
four_d = sqrtf(tr+1.0f);
dst->w = four_d*0.5f;
four_d = sqrtf(tr + 1.0f);
dst->w = four_d * 0.5f;
inv_half = 0.5f/four_d;
dst->x = (m->y.z - m->z.y)*inv_half;
dst->y = (m->z.x - m->x.z)*inv_half;
dst->z = (m->x.y - m->y.x)*inv_half;
inv_half = 0.5f / four_d;
dst->x = (m->y.z - m->z.y) * inv_half;
dst->y = (m->z.x - m->x.z) * inv_half;
dst->z = (m->x.y - m->y.x) * inv_half;
} else {
struct f4x4 *val = (struct f4x4*)m;
@ -81,20 +87,20 @@ void quat_from_matrix3(struct quat *dst, const struct matrix3 *m)
if (m->z.z > val->ptr[i][i])
i = 2;
j = (i+1)%3;
k = (i+2)%3;
j = (i+1) % 3;
k = (i+2) % 3;
/* ---------------------------------- */
four_d = sqrtf((val->ptr[i][i] - val->ptr[j][j] -
val->ptr[k][k]) + 1.0f);
dst->ptr[i] = four_d*0.5f;
dst->ptr[i] = four_d * 0.5f;
inv_half = 0.5f/four_d;
dst->ptr[j] = (val->ptr[i][j] + val->ptr[j][i])*inv_half;
dst->ptr[k] = (val->ptr[i][k] + val->ptr[k][i])*inv_half;
dst->w = (val->ptr[j][k] - val->ptr[k][j])*inv_half;
inv_half = 0.5f / four_d;
dst->ptr[j] = (val->ptr[i][j] + val->ptr[j][i]) * inv_half;
dst->ptr[k] = (val->ptr[i][k] + val->ptr[k][i]) * inv_half;
dst->w = (val->ptr[j][k] - val->ptr[k][j]) * inv_half;
}
}

2
libobs/graphics/quat.h
View File

@ -35,6 +35,7 @@ extern "C" {
#endif
struct matrix3;
struct matrix4;
struct axisang;
struct quat {
@ -162,6 +163,7 @@ static inline bool quat_close(const struct quat *q1, const struct quat *q2,
EXPORT void quat_from_axisang(struct quat *dst, const struct axisang *aa);
EXPORT void quat_from_matrix3(struct quat *dst, const struct matrix3 *m);
EXPORT void quat_from_matrix4(struct quat *dst, const struct matrix4 *m);
EXPORT void quat_get_dir(struct vec3 *dst, const struct quat *q);
EXPORT void quat_set_look_dir(struct quat *dst, const struct vec3 *dir);

18
libobs/graphics/vec3.c
View File

@ -16,12 +16,19 @@
******************************************************************************/
#include "vec3.h"
#include "vec4.h"
#include "quat.h"
#include "axisang.h"
#include "plane.h"
#include "matrix3.h"
#include "math-extra.h"
void vec3_from_vec4(struct vec3 *dst, const struct vec4 *v)
{
dst->m = v->m;
dst->w = 0.0f;
}
float vec3_plane_dist(const struct vec3 *v, const struct plane *p)
{
return vec3_dot(v, &p->dir) - p->dist;
@ -36,9 +43,19 @@ void vec3_rotate(struct vec3 *dst, const struct vec3 *v,
dst->x = vec3_dot(&temp, &m->x);
dst->y = vec3_dot(&temp, &m->y);
dst->z = vec3_dot(&temp, &m->z);
dst->w = 0.0f;
}
void vec3_transform(struct vec3 *dst, const struct vec3 *v,
const struct matrix4 *m)
{
struct vec4 v4;
vec4_from_vec3(&v4, v);
vec4_transform(&v4, &v4, m);
vec3_from_vec4(dst, &v4);
}
void vec3_transform3x4(struct vec3 *dst, const struct vec3 *v,
const struct matrix3 *m)
{
struct vec3 temp;
@ -47,6 +64,7 @@ void vec3_transform(struct vec3 *dst, const struct vec3 *v,
dst->x = vec3_dot(&temp, &m->x);
dst->y = vec3_dot(&temp, &m->y);
dst->z = vec3_dot(&temp, &m->z);
dst->w = 0.0f;
}
void vec3_mirror(struct vec3 *dst, const struct vec3 *v, const struct plane *p)

13
libobs/graphics/vec3.h
View File

@ -18,6 +18,7 @@
#pragma once
#include "math-defs.h"
#include "vec4.h"
#include <xmmintrin.h>
#ifdef __cplusplus
@ -26,6 +27,7 @@ extern "C" {
struct plane;
struct matrix3;
struct matrix4;
struct quat;
struct vec3 {
@ -53,6 +55,8 @@ static inline void vec3_copy(struct vec3 *dst, const struct vec3 *v)
dst->m = v->m;
}
EXPORT void vec3_from_vec4(struct vec3 *dst, const struct vec4 *v);
static inline void vec3_add(struct vec3 *dst, const struct vec3 *v1,
const struct vec3 *v2)
{
@ -131,6 +135,7 @@ static inline void vec3_neg(struct vec3 *dst, const struct vec3 *v)
dst->x = -v->x;
dst->y = -v->y;
dst->z = -v->z;
dst->w = 0.0f;
}
static inline float vec3_len(const struct vec3 *v)
@ -198,6 +203,7 @@ static inline void vec3_abs(struct vec3 *dst, const struct vec3 *v)
dst->x = fabsf(v->x);
dst->y = fabsf(v->y);
dst->z = fabsf(v->z);
dst->w = 0.0f;
}
static inline void vec3_floor(struct vec3 *dst, const struct vec3 *v)
@ -205,6 +211,7 @@ static inline void vec3_floor(struct vec3 *dst, const struct vec3 *v)
dst->x = floorf(v->x);
dst->y = floorf(v->y);
dst->z = floorf(v->z);
dst->w = 0.0f;
}
static inline void vec3_ceil(struct vec3 *dst, const struct vec3 *v)
@ -212,13 +219,17 @@ static inline void vec3_ceil(struct vec3 *dst, const struct vec3 *v)
dst->x = ceilf(v->x);
dst->y = ceilf(v->y);
dst->z = ceilf(v->z);
dst->w = 0.0f;
}
EXPORT float vec3_plane_dist(const struct vec3 *v, const struct plane *p);
EXPORT void vec3_transform(struct vec3 *dst, const struct vec3 *v,
const struct matrix4 *m);
EXPORT void vec3_rotate(struct vec3 *dst, const struct vec3 *v,
const struct matrix3 *m);
EXPORT void vec3_transform(struct vec3 *dst, const struct vec3 *v,
EXPORT void vec3_transform3x4(struct vec3 *dst, const struct vec3 *v,
const struct matrix3 *m);
EXPORT void vec3_mirror(struct vec3 *dst, const struct vec3 *v,

18
libobs/graphics/vec4.c
View File

@ -16,17 +16,27 @@
******************************************************************************/
#include "vec4.h"
#include "vec3.h"
#include "matrix4.h"
void vec4_from_vec3(struct vec4 *dst, const struct vec3 *v)
{
dst->m = v->m;
dst->w = 1.0f;
}
void vec4_transform(struct vec4 *dst, const struct vec4 *v,
const struct matrix4 *m)
{
struct vec4 temp;
struct matrix4 transpose;
temp.x = vec4_dot(&m->x, v);
temp.y = vec4_dot(&m->y, v);
temp.z = vec4_dot(&m->z, v);
temp.w = vec4_dot(&m->t, v);
matrix4_transpose(&transpose, m);
temp.x = vec4_dot(&transpose.x, v);
temp.y = vec4_dot(&transpose.y, v);
temp.z = vec4_dot(&transpose.z, v);
temp.w = vec4_dot(&transpose.t, v);
vec4_copy(dst, &temp);
}

3
libobs/graphics/vec4.h
View File

@ -24,6 +24,7 @@
extern "C" {
#endif
struct vec3;
struct matrix4;
struct vec4 {
@ -52,6 +53,8 @@ static inline void vec4_copy(struct vec4 *dst, const struct vec4 *v)
dst->m = v->m;
}
EXPORT void vec4_from_vec3(struct vec4 *dst, const struct vec3 *v);
static inline void vec4_add(struct vec4 *dst, const struct vec4 *v1,
const struct vec4 *v2)
{