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
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
|
/*
This file is part of LilyPond, the GNU music typesetter.
Copyright (C) 1997--2015 Han-Wen Nienhuys <hanwen@xs4all.nl>
LilyPond 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 3 of the License, or
(at your option) any later version.
LilyPond 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 LilyPond. If not, see <http://www.gnu.org/licenses/>.
*/
#include "offset.hh"
#ifndef STANDALONE
string
Offset::to_string () const
{
string s;
s = string (" (") + ::to_string (coordinate_a_[X_AXIS]) + ", "
+ ::to_string (coordinate_a_[Y_AXIS]) + ")";
return s;
}
#endif
/*
free bsd fix by John Galbraith
*/
Offset
complex_multiply (Offset z1, Offset z2)
{
Offset z;
if (!isinf (z2[Y_AXIS]))
{
z[X_AXIS] = z1[X_AXIS] * z2[X_AXIS] - z1[Y_AXIS] * z2[Y_AXIS];
z[Y_AXIS] = z1[X_AXIS] * z2[Y_AXIS] + z1[Y_AXIS] * z2[X_AXIS];
}
return z;
}
Offset
complex_conjugate (Offset o)
{
o[Y_AXIS] = -o[Y_AXIS];
return o;
}
Offset
complex_divide (Offset z1, Offset z2)
{
z2 = complex_conjugate (z2);
Offset z = complex_multiply (z1, z2);
z *= 1 / z2.length ();
return z;
}
Offset
complex_exp (Offset o)
{
Real s = sin (o[Y_AXIS]);
Real c = cos (o[Y_AXIS]);
Real r = exp (o[X_AXIS]);
return Offset (r * c, r * s);
}
Real
Offset::arg () const
{
return atan2 (coordinate_a_[Y_AXIS], coordinate_a_[X_AXIS]);
}
Real
Offset::angle_degrees () const
{
return arg () * 180 / M_PI;
}
/**
euclidian vector length / complex modulus
*/
Real
Offset::length () const
{
return hypot (coordinate_a_[X_AXIS], coordinate_a_[Y_AXIS]);
}
bool
Offset::is_sane () const
{
return !isnan (coordinate_a_[X_AXIS])
&& !isnan (coordinate_a_ [Y_AXIS])
&& !isinf (coordinate_a_[X_AXIS])
&& !isinf (coordinate_a_[Y_AXIS]);
}
Offset
Offset::direction () const
{
Offset d = *this;
if (isinf (d[X_AXIS]))
{
if (!isinf (d[Y_AXIS]))
return Offset ((d[X_AXIS] > 0.0 ? 1.0 : -1.0), 0.0);
}
else if (isinf (d[Y_AXIS]))
return Offset (0.0, (d[Y_AXIS] > 0.0 ? 1.0 : -1.0));
else if (d[X_AXIS] == 0.0 && d[Y_AXIS] == 0.0)
return d;
// The other cases propagate or produce NaN as appropriate.
d /= length ();
return d;
}
Offset
Offset::swapped () const
{
return Offset (coordinate_a_[Y_AXIS], coordinate_a_[X_AXIS]);
}
|
