123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151 |
- /******************************************************************************
- Copyright (C) 2023 by Lain Bailey <lain@obsproject.com>
- This program is free software: you can redistribute it and/or modify
- it under the terms of the GNU General Public License as published by
- the Free Software Foundation, either version 2 of the License, or
- (at your option) any later version.
- This program is distributed in the hope that it will be useful,
- but WITHOUT ANY WARRANTY; without even the implied warranty of
- MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- GNU General Public License for more details.
- You should have received a copy of the GNU General Public License
- along with this program. If not, see <http://www.gnu.org/licenses/>.
- ******************************************************************************/
- #include "../util/c99defs.h"
- #include "matrix3.h"
- #include "plane.h"
- void plane_from_tri(struct plane *dst, const struct vec3 *v1, const struct vec3 *v2, const struct vec3 *v3)
- {
- struct vec3 temp;
- vec3_sub(&temp, v2, v1);
- vec3_sub(&dst->dir, v3, v1);
- vec3_cross(&dst->dir, &temp, &dst->dir);
- vec3_norm(&dst->dir, &dst->dir);
- dst->dist = vec3_dot(v1, &dst->dir);
- }
- void plane_transform(struct plane *dst, const struct plane *p, 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, &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);
- }
- bool plane_intersection_ray(const struct plane *p, const struct vec3 *orig, const struct vec3 *dir, float *t)
- {
- float c = vec3_dot(&p->dir, dir);
- if (fabsf(c) < EPSILON) {
- *t = 0.0f;
- return false;
- } else {
- *t = (p->dist - vec3_dot(&p->dir, orig)) / c;
- return true;
- }
- }
- bool plane_intersection_line(const struct plane *p, const struct vec3 *v1, const struct vec3 *v2, float *t)
- {
- float p1_dist, p2_dist, p1_abs_dist, dist2;
- bool p1_over, p2_over;
- p1_dist = vec3_plane_dist(v1, p);
- p2_dist = vec3_plane_dist(v2, p);
- if (close_float(p1_dist, 0.0f, EPSILON)) {
- if (close_float(p2_dist, 0.0f, EPSILON))
- return false;
- *t = 0.0f;
- return true;
- } else if (close_float(p2_dist, 0.0f, EPSILON)) {
- *t = 1.0f;
- return true;
- }
- p1_over = (p1_dist > 0.0f);
- p2_over = (p2_dist > 0.0f);
- if (p1_over == p2_over)
- return false;
- p1_abs_dist = fabsf(p1_dist);
- dist2 = p1_abs_dist + fabsf(p2_dist);
- if (dist2 < EPSILON)
- return false;
- *t = p1_abs_dist / dist2;
- return true;
- }
- bool plane_tri_inside(const struct plane *p, const struct vec3 *v1, const struct vec3 *v2, const struct vec3 *v3,
- float precision)
- {
- /* bit 1: part or all is behind the plane */
- /* bit 2: part or all is in front of the plane */
- int sides = 0;
- float d1 = vec3_plane_dist(v1, p);
- float d2 = vec3_plane_dist(v2, p);
- float d3 = vec3_plane_dist(v3, p);
- if (d1 >= precision)
- sides = 2;
- else if (d1 <= -precision)
- sides = 1;
- if (d2 >= precision)
- sides |= 2;
- else if (d2 <= -precision)
- sides |= 1;
- if (d3 >= precision)
- sides |= 2;
- else if (d3 <= -precision)
- sides |= 1;
- return sides;
- }
- bool plane_line_inside(const struct plane *p, const struct vec3 *v1, const struct vec3 *v2, float precision)
- {
- /* bit 1: part or all is behind the plane */
- /* bit 2: part or all is in front of the plane */
- int sides = 0;
- float d1 = vec3_plane_dist(v1, p);
- float d2 = vec3_plane_dist(v2, p);
- if (d1 >= precision)
- sides = 2;
- else if (d1 <= -precision)
- sides = 1;
- if (d2 >= precision)
- sides |= 2;
- else if (d2 <= -precision)
- sides |= 1;
- return sides;
- }
|