/
geomath.cpp
37 lines (30 loc) · 1.23 KB
/
geomath.cpp
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
/** @file geomath.cpp
*
* @authors Copyright (c) 2018 Jaakko Keränen <jaakko.keranen@iki.fi>
*
* @par License
* LGPL: http://www.gnu.org/licenses/lgpl.html
*
* <small>This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU Lesser General Public License as published by
* the Free Software Foundation; either version 3 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 Lesser
* General Public License for more details. You should have received a copy of
* the GNU Lesser General Public License along with this program; if not, see:
* http://www.gnu.org/licenses</small>
*/
#include "gloom/geo/geomath.h"
using namespace de;
namespace gloom { namespace geo {
bool Plane::isPointAbove(const Vector3d &pos) const
{
return (pos - point).dot(normal) >= 0;
}
double Plane::project(const Vector2d &pos) const
{
const double d = -normal.x * point.x - normal.y * point.y - normal.z * point.z;
return (-normal.x * pos.x - normal.z * pos.y - d) / normal.y;
}
}} // namespace gloom::geo