nuclear@10: /* nuclear@10: libvmath - a vector math library nuclear@10: Copyright (C) 2004-2015 John Tsiombikas nuclear@10: nuclear@10: This program is free software: you can redistribute it and/or modify nuclear@10: it under the terms of the GNU Lesser General Public License as published nuclear@10: by the Free Software Foundation, either version 3 of the License, or nuclear@10: (at your option) any later version. nuclear@10: nuclear@10: This program is distributed in the hope that it will be useful, nuclear@10: but WITHOUT ANY WARRANTY; without even the implied warranty of nuclear@10: MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the nuclear@10: GNU Lesser General Public License for more details. nuclear@10: nuclear@10: You should have received a copy of the GNU Lesser General Public License nuclear@10: along with this program. If not, see . nuclear@10: */ nuclear@10: nuclear@10: #include "ray.h" nuclear@10: #include "vector.h" nuclear@10: nuclear@10: ray_t ray_transform(ray_t r, mat4_t xform) nuclear@10: { nuclear@10: mat4_t upper; nuclear@10: vec3_t dir; nuclear@10: nuclear@10: m4_copy(upper, xform); nuclear@10: upper[0][3] = upper[1][3] = upper[2][3] = upper[3][0] = upper[3][1] = upper[3][2] = 0.0; nuclear@10: upper[3][3] = 1.0; nuclear@10: nuclear@10: dir = v3_sub(r.dir, r.origin); nuclear@10: dir = v3_transform(dir, upper); nuclear@10: r.origin = v3_transform(r.origin, xform); nuclear@10: r.dir = v3_add(dir, r.origin); nuclear@10: return r; nuclear@10: }