summaryrefslogtreecommitdiff
path: root/i/marvin/src/utils/mathutil.hh
blob: d58cec3eb78896503231fa9ea96b6714513d9228 (plain)
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
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
#ifndef mathutil_hh
#define mathutil_hh
// mathutil.hh
// robert - programme du robot 2005. {{{
//
// Copyright (C) 2005 Nicolas Schodet
//
// Robot APB Team/Efrei 2005.
//        Web: http://assos.efrei.fr/robot/
//      Email: robot AT efrei DOT fr
//
// 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, write to the Free Software
// Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
//
// }}}
#include <cmath>

/// Normalise l'angle entre -pi et +pi.
double
angleNorm (double a);

/// Converti en coordonn�es polaires.
void
toPolar (double x, double y, double &r, double &a);

/// Normalise l'angle en [-pi..+pi).
inline double
angleNorm (double a)
{
    while (a >= M_PI)
	a -= 2.0 * M_PI;
    while (a < -M_PI)
	a += 2.0 * M_PI;
    return a;
}

/// Converti en coordonn�es polaires.
inline void
toPolar (double x, double y, double &r, double &a)
{
    // Rayon.
    r = sqrt (x * x + y * y);
    a = y > 0 ? acos (x / r) : -acos (x / r);
}

#endif // mathutil_hh