forked from gfrd/egfrd
-
Notifications
You must be signed in to change notification settings - Fork 1
Expand file tree
/
Copy pathDisk.hpp
More file actions
301 lines (252 loc) · 8.57 KB
/
Copy pathDisk.hpp
File metadata and controls
301 lines (252 loc) · 8.57 KB
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
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
221
222
223
224
225
226
227
228
229
230
231
232
233
234
235
236
237
238
239
240
241
242
243
244
245
246
247
248
249
250
251
252
253
254
255
256
257
258
259
260
261
262
263
264
265
266
267
268
269
270
271
272
273
274
275
276
277
278
279
280
281
282
283
284
285
286
287
288
289
290
291
292
293
294
295
296
297
298
299
300
301
#ifndef DISK_HPP
#define DISK_HPP
#include <ostream>
#include <cmath>
#include "Vector3.hpp"
#include "Shape.hpp"
#include "linear_algebra.hpp"
#include "utils/math.hpp"
template<typename T_>
class Disk
{
public:
typedef T_ value_type;
typedef Vector3<T_> position_type;
typedef T_ length_type;
typedef enum side_enum_type {} side_enum_type; // The typedef is a little bit C style but doesn't matter for C++
public:
// constructors
Disk()
: position_(), radius_(0), unit_z_() {}
Disk(position_type const& position, length_type const& radius,
position_type const& unit_z)
: position_(position), radius_(radius), unit_z_(unit_z) {}
bool operator==(const Disk& rhs) const
{
return position_ == rhs.position() && radius_ == rhs.radius() && unit_z_ == rhs.unit_z();
}
bool operator!=(const Disk& rhs) const
{
return !operator==(rhs);
}
position_type const& position() const
{
return position_;
}
position_type& position()
{
return position_;
}
length_type const& radius() const
{
return radius_;
}
length_type& radius()
{
return radius_;
}
position_type const& unit_z() const
{
return unit_z_;
}
position_type& unit_z()
{
return unit_z_;
}
const int dof() const
{ // degrees of freedom for particle movement
return 0;
}
std::string show(int precision)
{
std::ostringstream strm;
strm.precision(precision);
strm << *this;
return strm.str();
}
/////// Member variables
private:
position_type position_; // centre.
length_type radius_;
position_type unit_z_; // Z-unit_z. should be normalized.
};
//////// Inline functions
template<typename Tstrm_, typename T_>
inline std::basic_ostream<Tstrm_>& operator<<(std::basic_ostream<Tstrm_>& strm,
const Disk<T_>& v)
{
strm << "{" << v.position() << ", " << v.radius() << ", " << v.unit_z() << ", " << "}";
return strm;
}
template<typename T_>
inline boost::array<typename Disk<T_>::length_type, 2>
to_internal(Disk<T_> const& obj, typename Disk<T_>::position_type const& pos)
{
// Same as for the cylinder:
// Return pos relative to position of the disk.
typedef typename Disk<T_>::position_type position_type;
typedef typename Disk<T_>::length_type length_type;
const position_type pos_vector(subtract(pos, obj.position()));
const length_type z( dot_product(pos_vector, obj.unit_z()) ); // z can be < 0
const length_type r( length(subtract(pos_vector, multiply(obj.unit_z(), z))) );// r is always >= 0
return array_gen<typename Disk<T_>::length_type>(r, z);
}
template<typename T_>
inline std::pair<typename Disk<T_>::position_type,
std::pair<typename Disk<T_>::length_type,
typename Disk<T_>::length_type> >
project_point(Disk<T_> const& obj, typename Disk<T_>::position_type const& pos)
// Calculates the projection of 'pos' onto the disk 'obj' and also returns the coefficient
// for the normal component (z) of 'pos' in the basis of the disk and the distance of the
// projected point to the 'edge' of the disk. Here a positive number means the projected
// point is outside the disk, and a negative numbers means it is 'inside' the disk.
// As a special case, we calculate the projection differently for a position that is in
// the plane of the disk. Then we imagine that the particle is always 'above' the structure
// and return -1 as a standard, instead of the distance to the disk center.
{
typedef typename Disk<T_>::length_type length_type;
typedef typename Disk<T_>::position_type position_type;
// Here we do not call 'to_internal' for efficiency
const position_type pos_vector(subtract(pos, obj.position()));
const length_type z ( dot_product(pos_vector, obj.unit_z()) );
const position_type r_vector (subtract(pos_vector, multiply(obj.unit_z(), z)));
const length_type r (length(r_vector));
assert(r >= 0.0);
// The quantities that will be return, with default values
// for the standard case (pos is not in plane of disk)
position_type proj_pos( add(obj.position(), r_vector) );
length_type normal_comp( z );
length_type dist_to_edge( r - obj.radius() );
// Special case: pos is in the same plane as the disk
if( feq(z, 0.0, obj.radius()) ){ // third argument is typical scale
proj_pos = obj.position(); // projected position = disk center
normal_comp = r;
dist_to_edge = -1.0;
}
return std::make_pair( proj_pos,
std::make_pair(normal_comp, dist_to_edge) );
}
// The same as in case of the plane: project_point_on_surface = project_point
template<typename T_>
inline std::pair<typename Disk<T_>::position_type,
std::pair<typename Disk<T_>::length_type,
typename Disk<T_>::length_type> >
project_point_on_surface(Disk<T_> const& obj, typename Disk<T_>::position_type const& pos)
{
return project_point(obj, pos);
}
template<typename T_>
inline typename Disk<T_>::length_type
distance(Disk<T_> const& obj,
typename Disk<T_>::position_type const& pos)
{
//typedef typename Disk<T_>::position_type position_type;
typedef typename Disk<T_>::length_type length_type;
/* First compute the (r,z) components of pos in a coordinate system
* defined by the vectors unitR and unit_z, where unitR is
* choosen such that unitR and unit_z define a plane in which
* pos lies. */
const boost::array<length_type, 2> r_z(to_internal(obj, pos));
/* Then compute distance to cylinder with zero length. */
const length_type dz(std::fabs(r_z[1]));
const length_type dr(r_z[0] - obj.radius());
length_type distance;
if (dr > 0)
{
// pos is not above the disk.
// Compute distance to edge.
distance = std::sqrt( dz * dz + dr * dr );
}
else
{
// pos is above the disk.
distance = dz;
}
return distance;
}
template<typename T_>
inline std::pair<typename Disk<T_>::position_type, bool>
deflect(Disk<T_> const& obj,
typename Disk<T_>::position_type const& r0,
typename Disk<T_>::position_type const& d )
{
// Displacements are not deflected on disks (yet),
// but this function has to be defined for every shape to be used in structure.
// For now it just returns original pos. + displacement. The changeflage = false.
return std::make_pair( add(r0, d), false );
}
/*
template<typename T_>
inline typename Disk<T_>::position_type
deflect_back(Disk<T_> const& obj,
typename Disk<T_>::position_type const& r,
typename Disk<T_>::position_type const& u_z )
{
// Return the vector r without any changes
return r;
}
*/
template<typename T, typename Trng>
inline typename Disk<T>::position_type
random_position(Disk<T> const& shape, Trng& rng)
{
// The disk has only one "legal" position = its center
return shape.position();
}
template<typename T_>
inline Disk<T_> const& shape(Disk<T_> const& shape)
{
return shape;
}
template<typename T_>
inline Disk<T_>& shape(Disk<T_>& shape)
{
return shape;
}
template<typename T_>
struct is_shape<Disk<T_> >: public boost::mpl::true_ {};
template<typename T_>
struct shape_position_type<Disk<T_> >
{
typedef typename Disk<T_>::position_type type;
};
template<typename T_>
struct shape_length_type<Disk<T_> > {
typedef typename Disk<T_>::length_type type;
};
template<typename T>
inline typename shape_length_type<Disk<T> >::type const& shape_size(Disk<T> const& shape)
{
return shape.radius();
}
template<typename T>
inline typename shape_length_type<Disk<T> >::type& shape_size(Disk<T>& shape)
{
return shape.radius();
}
#if defined(HAVE_TR1_FUNCTIONAL)
namespace std { namespace tr1 {
#elif defined(HAVE_STD_HASH)
namespace std {
#elif defined(HAVE_BOOST_FUNCTIONAL_HASH_HPP)
namespace boost {
#endif
template<typename T_>
struct hash<Disk<T_> >
{
typedef Disk<T_> argument_type;
std::size_t operator()(argument_type const& val)
{
return hash<typename argument_type::position_type>()(val.position()) ^
hash<typename argument_type::length_type>()(val.radius()) ^
hash<typename argument_type::position_type>()(val.unit_z());
}
};
#if defined(HAVE_TR1_FUNCTIONAL)
} } // namespace std::tr1
#elif defined(HAVE_STD_HASH)
} // namespace std
#elif defined(HAVE_BOOST_FUNCTIONAL_HASH_HPP)
} // namespace boost
#endif
#endif /* DISK_HPP */