Planet
navi homePPSaboutscreenshotsdownloaddevelopmentforum

source: code/branches/core3/src/util/Math.cc @ 1777

Last change on this file since 1777 was 1777, checked in by rgrieder, 16 years ago

svn save

  • Property svn:eol-style set to native
File size: 8.3 KB
Line 
1/*
2 *   ORXONOX - the hottest 3D action shooter ever to exist
3 *                    > www.orxonox.net <
4 *
5 *
6 *   License notice:
7 *
8 *   This program is free software; you can redistribute it and/or
9 *   modify it under the terms of the GNU General Public License
10 *   as published by the Free Software Foundation; either version 2
11 *   of the License, or (at your option) any later version.
12 *
13 *   This program is distributed in the hope that it will be useful,
14 *   but WITHOUT ANY WARRANTY; without even the implied warranty of
15 *   MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
16 *   GNU General Public License for more details.
17 *
18 *   You should have received a copy of the GNU General Public License
19 *   along with this program; if not, write to the Free Software
20 *   Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
21 *
22 *   Author:
23 *      Fabian 'x3n' Landau
24 *   Co-authors:
25 *      ...
26 *
27 */
28
29#include "Math.h"
30
31#include <OgrePlane.h>
32#include "MathConvert.h"
33
34/**
35    @brief Function for writing to a stream.
36*/
37std::ostream& operator<<(std::ostream& out, const orxonox::Radian& radian)
38{
39    out << radian.valueRadians();
40    return out;
41}
42
43/**
44    @brief Function for reading from a stream.
45*/
46std::istream& operator>>(std::istream& in, orxonox::Radian& radian)
47{
48    float temp;
49    in >> temp;
50    radian = temp;
51    return in;
52}
53
54/**
55    @brief Function for writing to a stream.
56*/
57std::ostream& operator<<(std::ostream& out, const orxonox::Degree& degree)
58{
59    out << degree.valueDegrees();
60    return out;
61}
62
63/**
64    @brief Function for reading from a stream.
65*/
66std::istream& operator>>(std::istream& in, orxonox::Degree& degree)
67{
68    float temp;
69    in >> temp;
70    degree = temp;
71    return in;
72}
73
74
75float getAngle(const orxonox::Vector3& myposition, const orxonox::Vector3& mydirection, const orxonox::Vector3& otherposition)
76{
77    orxonox::Vector3 distance = otherposition - myposition;
78    return acos(mydirection.dotProduct(distance) / distance.length());
79}
80
81orxonox::Vector2 get2DViewdirection(const orxonox::Vector3& myposition, const orxonox::Vector3& mydirection, const orxonox::Vector3& myorthonormal, const orxonox::Vector3& otherposition)
82{
83    orxonox::Vector3 distance = otherposition - myposition;
84
85    // project difference vector on our plane
86    orxonox::Vector3 projection = Ogre::Plane(mydirection, myposition).projectVector(distance);
87    float angle = acos(myorthonormal.dotProduct(projection) / projection.length());
88
89    if ((mydirection.crossProduct(myorthonormal)).dotProduct(distance) > 0)
90        return orxonox::Vector2(sin(angle), cos(angle));
91    else
92        return orxonox::Vector2(-sin(angle), cos(angle));
93}
94
95orxonox::Vector2 get2DViewcoordinates(const orxonox::Vector3& myposition, const orxonox::Vector3& mydirection, const orxonox::Vector3& myorthonormal, const orxonox::Vector3& otherposition)
96{
97    orxonox::Vector3 distance = otherposition - myposition;
98
99    // project difference vector on our plane
100    orxonox::Vector3 projection = Ogre::Plane(mydirection, myposition).projectVector(distance);
101    float angle = acos(myorthonormal.dotProduct(projection) / projection.length());
102    float radius = acos(mydirection.dotProduct(distance) / distance.length()) / Ogre::Math::PI;
103
104    if ((mydirection.crossProduct(myorthonormal)).dotProduct(distance) > 0)
105        return orxonox::Vector2(sin(angle) * radius, cos(angle) * radius);
106    else
107        return orxonox::Vector2(-sin(angle) * radius, cos(angle) * radius);
108}
109
110orxonox::Vector3 getPredictedPosition(const orxonox::Vector3& myposition, float projectilespeed, const orxonox::Vector3& targetposition, const orxonox::Vector3& targetvelocity)
111{
112    float squaredProjectilespeed = projectilespeed * projectilespeed;
113    orxonox::Vector3 distance = targetposition - myposition;
114    float a = distance.squaredLength();
115    float b = 2 * (distance.x + distance.y + distance.z) * (targetvelocity.x + targetvelocity.y + targetvelocity.z);
116    float c = targetvelocity.squaredLength();
117
118    float temp = 4*squaredProjectilespeed*c + a*a - 4*b*c;
119    if (temp < 0)
120        return orxonox::Vector3::ZERO;
121
122    temp = sqrt(temp);
123    float time = (temp + a) / (2 * (squaredProjectilespeed - b));
124    return (targetposition + targetvelocity * time);
125}
126
127// std::string to Vector2
128bool explicitConversion(orxonox::Vector2* output, const std::string& input)
129{
130    unsigned int opening_parenthesis, closing_parenthesis = input.find(')');
131    if ((opening_parenthesis = input.find('(')) == std::string::npos) { opening_parenthesis = 0; } else { opening_parenthesis++; }
132
133    SubString tokens(input.substr(opening_parenthesis, closing_parenthesis - opening_parenthesis), ",", SubString::WhiteSpaces, false, '\\', true, '"', true, '\0', '\0', true, '\0');
134    if (tokens.size() >= 2)
135    {
136        if (!ConvertValue(&(output->x), tokens[0]))
137            return false;
138        if (!ConvertValue(&(output->y), tokens[1]))
139            return false;
140
141        return true;
142    }
143    return false;
144}
145
146// std::string to Vector3
147bool explicitConversion(orxonox::Vector3* output, const std::string& input)
148{
149    unsigned int opening_parenthesis, closing_parenthesis = input.find(')');
150    if ((opening_parenthesis = input.find('(')) == std::string::npos) { opening_parenthesis = 0; } else { opening_parenthesis++; }
151
152    SubString tokens(input.substr(opening_parenthesis, closing_parenthesis - opening_parenthesis), ",", SubString::WhiteSpaces, false, '\\', true, '"', true, '\0', '\0', true, '\0');
153    if (tokens.size() >= 3)
154    {
155        if (!ConvertValue(&(output->x), tokens[0]))
156            return false;
157        if (!ConvertValue(&(output->y), tokens[1]))
158            return false;
159        if (!ConvertValue(&(output->z), tokens[2]))
160            return false;
161
162        return true;
163    }
164    return false;
165}
166
167// std::string to Vector4
168bool explicitConversion(orxonox::Vector4* output, const std::string& input)
169{
170    unsigned int opening_parenthesis, closing_parenthesis = input.find(')');
171    if ((opening_parenthesis = input.find('(')) == std::string::npos) { opening_parenthesis = 0; } else { opening_parenthesis++; }
172
173    SubString tokens(input.substr(opening_parenthesis, closing_parenthesis - opening_parenthesis), ",", SubString::WhiteSpaces, false, '\\', true, '"', true, '\0', '\0', true, '\0');
174    if (tokens.size() >= 4)
175    {
176        if (!ConvertValue(&(output->x), tokens[0]))
177            return false;
178        if (!ConvertValue(&(output->y), tokens[1]))
179            return false;
180        if (!ConvertValue(&(output->z), tokens[2]))
181            return false;
182        if (!ConvertValue(&(output->w), tokens[3]))
183            return false;
184
185        return true;
186    }
187    return false;
188}
189
190// std::string to Quaternion
191bool explicitConversion(orxonox::Quaternion* output, const std::string& input)
192{
193    unsigned int opening_parenthesis, closing_parenthesis = input.find(')');
194    if ((opening_parenthesis = input.find('(')) == std::string::npos) { opening_parenthesis = 0; } else { opening_parenthesis++; }
195
196    SubString tokens(input.substr(opening_parenthesis, closing_parenthesis - opening_parenthesis), ",", SubString::WhiteSpaces, false, '\\', true, '"', true, '\0', '\0', true, '\0');
197    if (tokens.size() >= 4)
198    {
199        if (!ConvertValue(&(output->w), tokens[0]))
200            return false;
201        if (!ConvertValue(&(output->x), tokens[1]))
202            return false;
203        if (!ConvertValue(&(output->y), tokens[2]))
204            return false;
205        if (!ConvertValue(&(output->z), tokens[3]))
206            return false;
207
208        return true;
209    }
210    return false;
211}
212
213// std::string to ColourValue
214bool explicitConversion(orxonox::ColourValue* output, const std::string& input)
215{
216    unsigned int opening_parenthesis, closing_parenthesis = input.find(')');
217    if ((opening_parenthesis = input.find('(')) == std::string::npos) { opening_parenthesis = 0; } else { opening_parenthesis++; }
218
219    SubString tokens(input.substr(opening_parenthesis, closing_parenthesis - opening_parenthesis), ",", SubString::WhiteSpaces, false, '\\', true, '"', true, '\0', '\0', true, '\0');
220    if (tokens.size() >= 4)
221    {
222        if (!ConvertValue(&(output->r), tokens[0]))
223            return false;
224        if (!ConvertValue(&(output->g), tokens[1]))
225            return false;
226        if (!ConvertValue(&(output->b), tokens[2]))
227            return false;
228        if (!ConvertValue(&(output->a), tokens[3]))
229            return false;
230
231        return true;
232    }
233    return false;
234}
235
Note: See TracBrowser for help on using the repository browser.